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Abstract 

A previously  designed  extended  Kalman  filter,  based  upon  the 
proportional  guidance  law,  aerodynamic  drag  equation,  and  a first  order 
lag  model  of  the  missile  time  response;  is  modified  for  three  dimensional 
use.  Its  purpose  is  to  estimate  various  states  of  an  offensive  missile 
by  processing  the  line  of  sight  measurements  made  by  the  target  aircraft. 
A six-degree-of-freedom,  stochastic  missile  model  is  developed  and 
presented  in  Fortran  code.  Monte  Carlo  analyses  of  the  filter's  per- 
formance are  generated  fcr  four  different  trajectories.  These 
trajectories  test  for  different  orientations  of  the  line  of  sight, 
different  acceleration  profiles  of  the  missile,  and  different  amounts 
of  roll  induced  upon  the  missile  by  a three  dimensional,  conic  turn. 

The  extended  Kalman  filter  is  designed  in  the  line  of  sight  frame 
and  is  composed  of  eleven  states.  They  are:  two  line  of  sight  orien- 
tation angles,  two  inertial  angular  velocities  of  the  line  of  sight, 
range,  closing  velocity,  two  lateral  accelerations  of  the  missile,  and 
three  constant  parameters.  The  constant  parameters  are  the  propor- 
tional navigation  constant  (which  exploits  an  assumed  missile  guidance 
scheme),  a time  constant  (for  the  first  order  lag  model  of  missile 
time  response),  and  the  missile's  mass  over  surface  ratio  (for  computing 
aerodynamic  drag  of  the  missile).  The  filter  assumes  that  the  missile 
is  non-rolling  with  respect  to  the  line  of  sight  frame,  and  that  the 
line  of  sight  frame  is  non-rolling  with  respect  to  the  inertial  frame. 

It  also  assumes  that  the  missile  is  non-thrusting. 


x 


Preliminary  results  are  promising.  The  filter  is  only  tuned  for 
one  trajectory  due  to  time  limitations,  yet  its  estimation  of  the 
pointing-tracking  states  provide  good  aiding  for  all  trajectories. 
Parameter  estimates  and  missile  acceleration  estimates  for  the  other 
trajectories  are  degraded  due  to  improper  tuning  of  the  two  parameters. 
However,  it  is  felt  that  additional  tuning  of  those  parameters  will 
increase  the  filter's  accuracy  for  the  other  trajectories.  Plots  of 
the  Monte  Carlo  results  are  provided,  as  well  as  the  Fortran  computer 
program  used  in  the  simulation. 
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A PRACTICAL  THREE  DIMENSIONAL,  11 


STATE  EXTENDED  KALMAN  FILTER  FOR 
USE  IN  A FIRE  CONTROL  SYSTEM 
AGAINST  NON-THRUSTING  MISSILES 

I.  Purpose  of  Thesis 

Introduction 

In  tomorrow's  wartime  environment,  offensive  missiles  will  play  a 
leading  role.  Future  aircraft  must  either  neutralize  the  missile 
threat  or  avoid  it  altogether.  Current  research  is  focused  primarily 
on  neutralization  methods  involving,  among  other  things,  laser 
■weapons.  However,  certain  information  must  be  available  before  a 
laser  can  be  used  to  neutralize  a missile. 

The  most  obvious  requirement  is  information  about  the  missile's 
velocity  and  position.  Accuracies  required  by  a laser  weapon  are 
generally  beyond  the  reach  of  most  pointing-tracking  systems.  Aided 
pointing  and  tracking  systems  - those  systems  which  use  a stochastic 
kinematics  model  of  the  object  being  tracked  to  predict  future  position 
and  velocity  - have  met  with  varying  degrees  of  success  (Refs  1,4, 5, 9). 
Generally,  research  has  shown  that  the  more  accurate  the  stochastic 
model,  the  more  accurate  the  pointing  and  tracking.  Yet,  the  model 
must  be  simple  enough  to  be  practical.  By  limiting  the  variety  of 
tracked  objects  to  an  attacking  missile  - particularly  a non-thrusting 
missile  guided  by  proportional  navigation  - Cusumano  and  DePonte 


demonstrated  the  feasibility  of  a planar  (two  dimensional)  eight  state 
extended  Kalman  filter  based  upon  a first  order  lag  model  of  the 
missile's  lateral  acceleration  response.  This  filter  model,  when 
compared  to  filters  incorporating  less  structural  acceleration  models 
(such  as  first  order  Gauss-Markov  models),  increases  the  accuracy  of 
two  dimensional  pointing  and  tracking  against  a wide  variety  of  pro- 
portional navigation  missiles.  But  other  requirements  must  be 
fulfilled  as  well. 

A not-so-obvious  reauirement  is  threat  evaluation.  Obviously,  if 
a missile  is  not,  or  will  not,  be  a threat,  no  action  against  it  is 
required.  In  a multiple  missile  environment,  knowledge  of  each 
missile's  threat  may  mean  the  difference  between  life  and  death.  Not 
only  is  it  necessary  to  neutralize  the  most  threatening  missile;  it 
is  also  necessary  to  quit  neutralizing  as  soon  as  the  missile  loses 
track  and  to  move  on  to  the  next  threat.  In  this  way,  the  aircraft's 
defensive  capability  is  greatly  increased. 

It  appears,  however,  that  laser  weapons  will  require  a rather 
large  airframe.  Therefore,  fighter  aircraft  will  still  need  to 
practice  avoidance  techniques.  Current  avoidance  techniques  rely  on 
intelligence  reports  to  help  plan  a low  threat  route.  When  something 
goes  awry  and  the  aircraft  is  attacked,  it  attempts  to  "lose"  the 
missile  through  the  use  of  special  maneuvers.  In  fact,  "wild  weasels" 
purposely  engaged  surface-to-air  missiles  during  the  Vietnam  war  to 
discover  launch  sites.  These  special  mission  aircraft  successfully 
outmancuvercd  the  missile  and  destroyed  the  launch  site. 

However,  these  techniques  rely  on  humans  to  maneuver  the  aircraft. 
Studies  show  humans,  are  limited  in  the  number  of  tasks  that  can  be 


handled  at  one  time  as  well  as  the  speed  of  accomplishment  (Kef  15:17-39). 
In  future  wars,  low  threat  routes  may  not  be  available.  In  addition,  a 
multiple  missile  threat  will  probably  be  too  fast-paced  and  complex  for 
humans  to  handle.  Therefore,  some  machine  must  be  used  to  extend  the 
human  capabilities. 

One  such  machine  could  be  a computerized  autopilot  that  employs  a 
stochastic  missile  model.  This  type  of  autopilot  could  obtain  estimates 
of  missile  lateral  accelerations  and  dynamic  response  characteristics. 
With  this  knowledge,  special  algorithms  would  choose  the  best  maneuver 
that  would  cause  the  missile  to  attempt  to  exceed  its  performance 
limitations.  Thus,  the  missile  is  avoided.  Missile  threats  could  be 
handled  one  at  a time  or,  ultimately,  all  at  once.  But  this  method  is 
definitely  beyond  the  scope  of  this  thesis.  Rather,  the  objective  of 
this  thesis  is  to  take  one  more  step  towards  a stochastic  model  capable 
of  being  used  in  a system  for  threat  neutralization  and  threat  avoi- 
dance. 

Statement  of  the  Problem 

The  research  of  Cusumano  and  DePonte  demonstrates  that  a reduced 
order  model  for  the  missile's  lateral  acceleration  response  (specific- 
ally, a first  order  lag),  can  be  used  in  an  extended  Kalman  filter  as 
an  effective  aid  to  pointing  and  tracking  (Ref  1).  However,  the 
extended  Kalman  filter,  and  the  model  upon  which  it  is  based,  is 
planar  (two  dimensional)*.  In  addition,  the  filter's  performance  is 
proven  for  only  two,  missile-target  trajectories.  Therefore,  this 

Note:  Throughout  this  thesis,  the  term  "dimensional"  will  refer  to  the 
physical  system,  i.e.  two  dimensional  is  planar,  three  dimen- 
sional is  the  physical  world.  The  size  of  a filter  will  be 
referred  to  as  "states",  such  as  "eight  states"  and  "11  states". 
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thesis  will  build  two  extended  Kalman  filters  appropriate  to  a realistic 
three  dimensional  environment  and  test  them  under  a variety  of  trajec- 
tories . 

Two  ways  to  build  a filter  are  proposed.  The  first  way  projects 
three  dimensional  line  of  sight  (the  vector  that  points  from  the 
missile  to  the  target)  motion  into  two,  orthogonal,  vertical  planes. 

A two  dimensional,  eight  state  extended  Kalman  filter  is  used  in  each 
plane  to  obtain  state  estimates  of  the  two  projections.  These  two  sets 
of  state  estimates  are  then  used  to  obtain  three  dimensional  estimates 
of  the  line  of  sight  motion,  thus  aiding  the  three  dimensional  pointing 
and  tracking  problem.  But  this  filter  is  limited  to  the  performance 
demonstrated  by  Cusumano  and  DePonte.  Approximations  necessary  for 
three  dimensional  application  will  most  probably  reduce  the  filter's 
accuracy  unacceptably.  The  second  way  builds  an  extended  Kalman  filter 
based  upon  a three  dimensional  missile  model  and  is  potentially  more 
accurate. 

The  three  dimensional  missile  model  will  "split"  the  missile  into 
two  orthogonal  planes.  A first  order  lag  model  of  missile  response 
will  be  used  for  each  missile  plane.  The  two  missile  response  models 
will  be  coupled  to  the  three  dimensional  measurements  available  from  a 
pointing-tracking  system.  It  is  conceivable  that  a different  choice  of 
state  space  and/or  the  processing  of  additional  information  available 
from  sensors  within  the  target  aircraft  could  improve  filter  performance 
beyond  the  capability  demonstrated  by  Cusumano  and  DePonte.  Therefore, 
these  factors  will  be  investigated. 

Since  the  second  approach  shows  greater  promise  than  the  first, 
the  following  objectives  are  established: 


P 
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1.  The  three  dimensional  application  of  2,  eight-state  fil- 
ters will  be  investigated,  primarily  as  a learning  tool 
for  gaining  the  physical  insights  into  a missile-target 
encounter  which  are  required  to  accomplish  the  second 
objective.  No  attempt  will  be  made  to  produce  a proven, 
workable  filter  since  this  approach  is  not  fruitful  in 
generating  a filter  with  acceptable  performance. 

2.  A three  dimensional  missile  model  will  be  designed  and 
incorporated  into  an  extended  Kalman  filter.  This  model 
will  be  an  extension  of  the  work  accoirplished  by 
Cusumano  and  DePontc.  The  filter  will  be  tested  against 
a representative  variety  of  trajectories.  Recommenda- 
tions will  be  made  to  direct  future  research. 

In  both  the  above  objectives,  the  results  obtained  by  Cusumano  and 
DePonte  (Ref  1,2)  will  be  used  as  a baseline  for  comparison.  Time 
constraints  imposed  upon  this  thesis  will  have  a major  impact  upon  the 
accomplishment  of  these  objectives. 

Monte  Carlo  Analysis 

Both  objectives  require  tests  to  be  performed  on  extended  Kalman 
filters.  The  evaluation  of  an  extended  Kalman  filter  requires  the  use 
of  a Monte  Carlo  analysis.  A complete  description  of  a Monte  Carlo 
analysis  is  contained  in  Reference  7. 

In  a Monte  Carlo  analysis,  the  filter's  estimates  of  the  states 
arc  compared  to  the  true  values  of  those  states  (which  are  computed 
by  a "truth  model")  during  one  missile-target  engagement.  To  produce 
one  test,  the  engagement  is  repeated  several  times  with  different 
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samples  of  simulated  noises.  The  comparisons  from  each  engagement  are 
statistically  averaged  to  demonstrate  the  filter's  performance.  The 
more  engagements  that  are  averaged,  the  closer  the  test  results 
demonstrate  the  true  statistical  performance  of  the  filter.  However, 
each  engagement,  or  run,  adds  to  the  cost  of  a Monte  Carlo  analysis. 
Therefore,  an  appropriate  number  of  runs,  p,  must  be  chosen. 

To  demonstrate  the  validity  of  the  choice  for  p,  a variance  con- 
version chart  is  constructed  (see  Figure  1).  The  variance  observed 
for  one  particular  data  point  as  the  number  of  runs,  p,  is  increased 
is  plotted.  As  p increases,  the  computed  sample  variance  converges 
to  the  true  variance  value.  However,  not  all  data  points  converge  at 
the  same  rate.  Since  it  is  possible  that  this  data  point  will  converge 
quickly,  thus  falsely  indicating  convergence  for  all  data  points  after 
only  a few  runs,  four  data  points  are  analyzed.  The  variance  of  the 
slowest  converging  data  point  is  used  to  determine  an  appropriate  p. 

The  tests  performed  in  this  thesis  show  excellent  variance  conversion 
for  p equal  to  twenty.  The  Monte  Carlo  results,  which  are  contained 
in  the  appendices,  have  variance  conversion  charts  for  each  test. 
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II.  System  Truth  Models 


Ini  reduct i on 

The  truth  model  which  is  required  in  a Monte  Carlo  analysis  is  an 
accurate  mathematical  representation  of  the  real  world.  It  is  used  to 
test  and  fine  tunc  the  performance  of  the  extended  Kalman  filter  by 
providing  true  values  of  the  states  which  the  filter  is  estimating. 
Thus,  errors  in  the  filter's  state  estimates  can  be  evaluated  statis- 
tically. Any  errors  or  invalid  assumptions  in  the  truth  model  will 
corrupt  the  "true  values"  and  degrade  the  effectiveness  of  filter 
veri f i cat  ion . Therefore,  it  is  essential  for  the  truth  model  to 
portray  the  real  world  phenomena  as  accurately  as  possible. 

The  truth  model  used  in  this  Monte  Carlo  analysis  is  composed  of 
two  component  system  models  - one  for  the  missile  and  one  for  the 
target.  Previous  theses  are  used  extensively  for  the  numerical 
details  of  each  system  model  (Ref  1,5).  However,  the  modeling 
approach  for  the  missile  is  significantly  altered  to  insure  an 
accurate,  three-dimensional  representation.  The  target  truth  model 
requires  only  minor  modification. 

Ml ssi 1 c Model 

Models  for  guided  missiles  can  be  partitioned  into  three  blocks: 
the  seeker  block,  the  guidance  block,  and  the  autopilot/dynamics  block. 
The  seeker  block  measures  the  target's  relative  position  and/or 
dynamics.  The  guidance  block  uses  these  measurements  to  determine 
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missile  acceleration  commands  (or  actuator  commands)  that  will  cause 


target  intercept.  The  autopilot/dynamics  block  transforms  the  acceler- 
ation commands  into  lifting  forces,  which  produce  lateral  accelerations. 
Time  lags,  errors  in  design  assumptions,  and  environmental  disturbances 
can  cause  errors  in  target  intercept. 

This  missile  truth  model  uses  a vector  approach,  representing 
necessary  information  as  inertially  coordinatized  vectors,  uncoordina- 
tized  vectors,  and  scalars.  An  inertially  coordinatized  vector,  which 
is  a set  of  three  component  values,  is  represented  as  a capital  letter 
with  an  underline  (R) . Underlined  small  letters  (r)  represent 
coordinatized  unit  vectors.  The  uncoordi natized  vector,  which  is  a 
single  value,  is  represented  as  a capital  letter  without  underline  (R). 
An  uncoordinatized  vector  is  simply  a magnitude  (length)  of  a vector 
with  sign  (direction)  information.  Thus,  R=5  points  in  the  opposite 
direction  of  R=-5.  However,  R is  not  defined  in  relation  to  inertial 
space.  A scalar  is  represented  as  a small  letter  without  an  under- 
line (k). 

Three  reference  frajnes  are  used  in  the  missile  model:  the  inertial 
frame  (i),  the  missile  body  frame  (b),  and  the  missile  seeker  frame 
(s).  The  origin  of  the  inertial  frame  is  located  at  the  target's 
position  at  the  start  of  the  engagement  and  remains  inertially  fixed 
(see  Figure  2).  The  missile's  initial  position  is  in  the  ( i_, , i_2 ) 
plane  (the  plane  formed  by  the  two  axes  j_[  and  j_2 ) . The  axes  _ij  and  i_, 
are  horizontal,  and  i_2  is  vertical  (up).  The  axis  i_,  points  away  from 
the  missile,  as  in  the  figure.  The  inertial  angular  velocity  of  the 
earth  is  assumed  to  be  negligible  during  the  short  period  of  engagement. 
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r^-  = i 

Therefore,  the  (i,,  is)  plane  is  always  horizontal.  Gravity  is  assumed 
to  be  in  the  -i2  direction  with  constant  magnitude. 

The  origin  of  the  missile  body  (b)  frame  is  the  missile's  center 
of  mass  (see  Figure  3).  The  missile  centerline  is  the  bj  axis.  However, 
unlike  conventional  body  frames,  the  b2  axis  points  out  of  the  top  of 
the  missile  (negative  conventional  yaw  axis)  and  the  b,  axis  points  out 
of  the  missile's  right  side  (positive  conventional  pitch  axis).  This 
unconventional  body  frame  allows  easier  modification  of  previously 
developed  computer  software  (Ref  1). 

To  simplify  the  missile  model,  the  seeker's  inertial  angular  velo- 
city is  assumed  to  be  independent  of  the  missile's  inertial  angular 
velocity  (incrtially  stablized  seeker).  Moreover,  the  distance  between 
the  missile's  center  of  mass  and  the  seeker  is  assumed  to  be  negligible 
relative  to  other’  distances  in  the  problem,  such  as  range.  Therefore, 
the  origin  of  the  seeker  (s)  frame  is  assumed  to  be  the  missile's 
center  of  mass.  Located  at  this  origin  is  the  seeker  pivot  point 
(see  Figure  4).  The  seeker's  centerline  is  the  s,  axis.  The  s,  axis 
is  constrained  to  the  ( b 2 , b s ) plane.  The  s2  axis  finishes  the  right- 
hand  orthogonal  s frame.  Thus,  the  three  coordinate  frames  are 
defined . 

Seeker  Bl ock 

The  missile  seeker  contains  a sensor  (much  like  the  human  eye 
looking  through  a rifle  scope)  that  develops  an  output  if  the  target  is 
not  centered  in  its  field  of  view.  This  output  is  fed  back  into  a 
driving  mechanism  or  driver  (the  arms  holding  the  rifle),  which  moves 
the  sensor  to  center  the  target.  When  the  target  is  centered,  the 
sensor  output  is  zero. 


A 


u 
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The  sensor's  field  of  view  can  be  represented  as  a circular  disc 
parallel  to  the  (s2,  s3)  plane.  Its  center  is  located  an  arbitrary 
distance  from  the  seeker  pivot  point  (see  Figure  5).  The  crosshairs 
of  the  sensor  are  in  the  s2  and  s3  directions,  respectively.  The 
drivers  arc  located  at  the  seeker  pivot  point  and  produce  inertial 
angular  motion  of  the  seeker.  One  driver  produces  inertial  rotation  in 
the  s2  direction  only;  the  other  driver  produces  inertial  rotation  only  in 
the  Sj  direction.  The  pivot  point  is  physically  constructed  such  that 
Sj  remains  in  the  ( b 2 , b3 ) plane.  In  this  way,  the  pitch  and  yaw  axes 
of  the  seeker  remain  properly  oriented  to  the  pitch  and  yaw  axes  of 
the  missile,  allowing  seeker  outputs  to  be  directly  coupled  to  the 
guidance  block. 

Most  two  dimensional  seekers  can  be  modeled  as  two  independent 
first  order  lag  networks  - one  for  each  direction  (Ref  11:32).  The 
inertial  angular  rate  of  the  sensed  line  of  sight  vector  is  the 
network's  input;  the  angle  0,  between  the  sensed  line  of  sight  vector, 
r , and  the  seeker  centerline,  s,,  is  the  network's  output.  Seeker 

•“oLUo 

block  outputs,  however,  are  often  the  inertial  angular  rates  of  the 
seeker  - the  feedback  portion  of  the  first  order  lags.  (The  sensed 
line  of  sight  vector  points  from  the  missile  to  the  apparent  position 
of  the  target.)  Since  0 must  be  small  for  most  sensors  to  lock  on  to 
the  target,  it  can  be  treated  as  a vector  and  broken  into  components 
corresponding  to  each  lag  circuit  (see  Figure  6).  (If  large  angles 
are  admissable,  order  of  rotation  becomes  important,  making  this  type 
of  sensor  nonlinear.)  A linear  sensor  will  produce  two  voltage 
outputs,  each  proportional  to  the  respective  error  angle  component. 

These  voltages  are  amplified  into  currents  and  fed  into  the  drivers. 
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A constant  current  coupled  to  a linear  driver  on  a frictionless  pivot 
produces  a constant  angular  rate  of  the  seeker  (Ref  3).  It  is  assumed 
that  this  ideal  seeker  model  adequately  represents  seeker  performance. 

To  mechanize  the  seeker  models,  the  error  angle  component  vectors, 
02  and  03 (which  are  the  component  vectors  of  0)  must  be  modeled.  These 
angular  components  can  be  defined  in  terms  of  0;  and  the  unit  vector 
that  points  from  the  intersection  of  the  seeker  centerline  and  the 
sensor  field  of  view,  to  the  intersection  of  the  sensed  line  of  sight 
r and  the  sensor  field  of  view  (see  Figures  5 and  6).  The 

— bLUb 

equations  that  describe  this  relationship  are: 

. 02  = 0(s3  • k ) (1) 

0.  = e(s2  • k ) (2) 

• — —a 

where  k^  = the  unit  vector  that  points  in  the  direction  of  the  sensor 
error.  The  unit  vector  k^  can  be  approximated  as: 


k 

-a 


-SI, OS 

l-SLOS  ~ -1 


(3) 


Note:  Equations  (1),  (2),  and  (3)  require  0 to  be  small  enough  to  be 
treated  as  a vector. 

The  error  angle,  0,  is  defined  through  the  dot  product  formula 
to  be: 

0 = cos"1  (s,  • rSL0S)  (/l) 

where  the  valid  region  of  0 is  0 < 0 < 1 

Note  (hat  (he  definitions  of  0 and  k determine  the  directions  of  02 

—a  — 
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and  0 3 in  equations  (1)  and  (2).  Positive  02  is  a rotation  about  the 
— s 2 axis,  and  positive  03  is  a rotation  about  the  s3  axis.  This 
convention  allows  equations  from  both  missile  planes  (equations  (1) 
and  (2))  to  be  identical  - a practice  that  will  also  be  used  in  the 
dynamics  block.  When  these  components  are  used  in  the  first  order  lag 
seeker  model,  the  set  of  equations  becomes: 


W2 


-1 


s 


(5) 


03 

K, 


1 

+ — 


(6) 


where  W2 , W3  = s2,  s,  components  of  the  inertial  angular  velocity  of 
ISLOS  (rad/sec) 

0 2 , 0S  = -s2 , s3  components  of  the  error  angle,  0 (rad) 
s = Laplace  transform  s 
tj  = seeker  time  constant  (sec) 

Different  seeker  time  constants  could  be  specified  to  model  a seeker 
with  different  dynamic  characteristics  about  its  two  pivot  axes. 

The  outputs  of  the  seeker  block,  W and  W , are  the  feedback 
portions  of  the  two  first  order  lag  models  (see  Figure  7).  They  are 
also  two  of  the  three  seeker  frame  components  of  the  seeker  frame 
inertial  angular  velocity.  The  third  seeker  frame  component,  ^ , is 
in  the  s,  direction.  The  vector  addition  of  W and  W must  be  in 

— —SI  — S2 

the  b2  direction  to  maintain  the  constraints  imposed  by  the  seeker 
frame's  definition,  i.e.  the  constraint  on  ss  to  lie  in  the  (b, , b3 ) 
plane.  From  geometry  (see  Figure  8) 
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(7) 


w - w co  + e 
Sl  Si  s 

where  0g  = the  angle  between  £j  and  b2  (rad) 

W = inertial  angular  velocity  of  seeker  along  ^ axis  (rad/sec) 

W = inertial  angular  velocity  of  seeker  along  s2  axis  (rad/sec) 

The  seeker  frame  inertial  angular  velocity  (in  inertial  coordinates)  is 

W = W + W + W (8) 

— S — S 1 — S 2 — s 3 

W = 

— s 

seeker  frame  inertial  angular  velocity  in  i,  direction 
( rad/ sec ) 

seeker  frame  inertial  angular  velocity  in  i 2 direction 
(rad/sec) 

seeker  frame  inertial  angular  velocity  in  i 3 direction 
( rad/scc) 

W will  be  used  to  determine  the  orientation  of  the  seeker  frame. 

— s 

The  orientation  of  the  seeker  frame  in  terms  of  the  inertial  frame 
is  defined  to  be: 


s, 

[1  0 

0]T 

(10) 

■■■'I 

fo  1 

0]T 

(H) 

s,  = C» 

[0  0 

1]T 

(12) 

s • • 

where  C.  = direction  cosine  matrix 

i 

from 

i to  s frame. 

where 


sx 


sy 


sz 


sx 


sy 


sz 


(9) 
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The  dynamics  of  the  direction  cosine  matrix  are  specified  by  (Fief  16:23) 


where 


1 


wik 

] S 


(13) 


p = first  derivative  with  respect  to  time 


■ 0 

—CO 

sz 

(0 

sy 
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sx 

-w 

L sy 

(0 

sx 
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By  integrating  equation  (13),  the  orientation  of  the  seeker  frame  is 
specified.  Thus,  the  dynamics  of  the  seeker  block,  from  the  sensed 
line  of  sight  to  the  seeker  bloc!:  outputs,  N ^ and  , arc  specified. 
To  complete  the  description  of  the  seeker  block,  the  sensed  line  of 
sight,  rSLQg,  must  be  specified. 

The  sensed  line  of  sight,  r is  derived  in  the  simulation 

from  the  true  line  of  sight,  r^^,  which  is  the  unit  vector  that  points 
from  the  missile  position  to  the  true  target  position.  The  true  line 
of  sight  is  bent  and  distorted,  much  like  the  image  of  a fish  in 
water  is  displaced  and  distorted  by  water  ripples  and  angle  of  sight . 
The  missile's  nose  cone  produces  aberration  error,  similar  to  errors 
caused  by  the  refraction  of  light.  Glint,  thermal,  and  scintillation 
noises  (Ref  5:27-30)  further  corrupt  the  image  position,  like  ripples 
in  the  water.  To  account  for  these  effects,  the  true  line  of  sight, 
ri  , is  rotated  bv  an  aberration  error  angle  and  two  noise  angles. 

One  simple  model  for  the  aberration  error  angle  (which  assumes 
a symmetrical  nose  cone)  is  (Ref  5:11-13) 
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hk. 


(14) 


where  = proportionality  constant 

4>  = the  angle  from  missile  centerline  to  the  true  line  of  sight. 
The  angle  $ is  found  from  the  dot  product  formula  to  be: 

= cos-1  (b,  • r ) (15) 

Tlie  direction  of  rotation  of  4>  is  the  direction  of  bj  x £^qC  • Thus, 

the  coordinati zed  vector,  j>  is  defined.  The  true  line  of  sight,  £LqS> 

is  rotated  through  the  angle  to  produce  the  intermediate  line  of 

sight  vector,  £jlos»  which  must  be  further  rotated  by  two  noise  angles 

to  produce  £ (See  Appendix  A for  planar  rotations  of  vectors.) 

Lutter  found  that  noise  which  corrupts  the  line  of  sight's 

direction  can  be  modeled  as  a combination  of  exponentially  correlated 

Gaussian  noise  added  to  a Gaussian  white  noise  (Ref  5:30).  From  the 

assumption  of  symmetry,  two  orthogonal  noise  angles  with  identical 

statistics  can  be  used  to  account  for  three  dimensional  line  of  sight 

noises.  The  statistics  used  for  the  two  noise  angles,  4>  and  $ , 

are  obtained  from  previous  research  and  are  presented  in  Table  I 

(Ref  5:30-31).  Although  noise  angles  arc  small,  the  computer  software 

developed  in  Appendix  A is  easier  to  apply  if  order  of  rotation  is 

modeled.  Therefore,  the  directions  of  $ and  $ are  modeled 

-n i -n 2 

orthogonal  to  the  vector  each  corrupts  and  to  each  other.  The  direction 


TABLE  1 


Sigmas  and  Time  Constants 
for  Line  of  Sight  Noise 


NOISE  ANGLE 

SIGMA 

TIME  CONTROL 

* 

ni 

.003  rad 

.000894  rad 

0.1  sec 

112 

.003  rad 

.000894  rad 

0.1  sec 

direction  of  r , (r  " ),  is  crossed  into  to  define  the  direction 

1 LUo  “*  1 LvJo  11 1 

of  0 • The  vector  r*_  _ is  rotated  through  the  angle  C>  to  produce 

the  sensed  line  of  sight,  r 

The  seeker  block  of  the  missile  has  been  fully  modeled,  from  the 
corruption  of  the  true  line  of  sight  to  the  seeker  outputs,  and  ^ 

The  orientation  of  the  seeker  frame  is  specified  for  all  time.  The 
seeker  outputs  are  passed  directly  to  the  guidance  block,  which 
produces  commanded  accelerations. 

Gui dance  Block 

Ideally,  if  the  seeker  has  no  inertial  angular  velocity 
(W  = W = 0)  for  all  time,  the  missile  will  hit  the  target.  Another 

— s 2 — S 3 

way  of  stating  this  is  that  the  inertial  angular  orientation  of  the 
true  line  of  sight,  r , remains  unchanged.  If,  however,  has  an 

inertial  angular  velocity,  the  missile  is  not  on  a collision  course 
with  the  target.  The  guidance  block's  purpose  i s to  generate  a set 
of  control  commands  that  will  drive  the  missile  to  the  target. 

Various  complexities  of  guidance  laws  exist,  but  the  most  common 
and  easiest  to  use  is  proportional  navigation.  Although  this  guidance 
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law  is  not  optimal  for  most  engagements,  other  developed  guidance 
schemes  are  too  complex  for  on-line  implementation,  or  approximate 
proportional  navigation  iti  some  form  (lief  11,12).  In  an  ideal  model, 
the  proportional  navigation  rule  commands  a missile  acceleration*  pro- 
portional to  the  closing  velocity  times  the  Inertial  angular  velocity 
of  the  true  line  of  sight.  The  three  dimensional  scalar  equations 
expressed  in  vector  notation  are:  (Ref  11:13) 

A = n(N  x V ) (16) 

— c — L — C 

where  = inertial  angular  velocity  of  r? ^ (rad/sec) 

V.,  = closing  velocity  of  the  missile  (ft/sec) 

“V 

n = proportional  navigation  constant 

- missile  acceleration  required  to  null  angular  motion  of 
the  line  of  sight  vector  (ft/sec*) 

The  proportionality  constant,  n,  is  chosen  by  the  missile  designer  and 
typically  ranges  between  three  and  five  (Ref  11:18).  The  closing 
velocity,  V^,  is  the  line  of  sight  velocity  of  the  missile  relative 
to  the  target.  In  practice,  the  closing  velocity  is  either  derived 
from  the  seeker  or  its  magnitude  is  estimated  before  launch  and  set 
as  a constant.  The  missile  in  this  study  uses  a noise  corrupted 
measurement  of  the  closing  velocity. 

The  guidance  block  does  not  have  the  angular  velocily  of  the 
true  line  of  sight  at  its  disposal.  Instead,  a noise  corrupted 
measurement  of  Wj  is  available.  Therefore,  a first  order  lag 

* Lateral  acceleration  is  equal  to  the  lift  generated  by  the  missile 
flight  control  surfaces  divided  by  the  missile  mass. 
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pre-filter  is  used  to  smooth  out  the  measurements.  In  addition,  the 
acceleration  required  by  this  rule  must  be  perpendicular  to  the  line 
of  sight.  Yet  tire  missile  produces  accelerations  through  lifting 
forces  perpendicular  to  the  missile  centerline.  Since  the  missile 
centerline  does  not  usually  coincide  with  the  line  of  sight,  the 
missile  produced  acceleration  is  not  colinear  with  the  required 
acceleration.  A correction  factor  must  be  used  to  modify  the  produced 
acceleration.  In  this  way,  the  component  of  missile  lateral  accelera- 
tion that  is  perpendicular  to  the  line  of  sight  will  equal  the 
acceleration  required  by  the  proportional  navigation  law.  (Ref  11:13-14). 
The  correction  factor,  although  different  for  different  trajectories, 
is  relatively  constant  throughout  one  trajectory.  Therefore,  many 
missile  designs  incorporate  the  correction  into  n by  increasing  its 
value.  Proportional  navigation  laws  using  this  type  of  correction 
have  n ranging  from  3 to  10  (Ref  13:7).  If  a larger  range  for  n is 


used  as  compensation,  then  the  two  guidance  equations  that  describe 
the  guidance  block  outputs  (which  assume  a symmetrical  guidance  block) 


nW  V„ 

S 3 C 


-nlV  V„ 
S!  C 


where  A = commanded  acceleration  along  b2  axis  (ft/sec2) 

C2  - 

A = commanded  acceleration  along  b,  axis  (ft/sec2) 

c s - 

n = proportional  navigation  constant 


s = laplace  transform  "s" 


r 

t 2 = prefilter  time  constant  (sec) 

Equations  (17)  and  (18)  are  used  in  the  missile  truth  model  to  describe 
the  missile  guidance  block. 

Autopilot /Dynam i c s Block 

Commanded  accelerations,  A and  A , are  processed  by  the  auto- 

— c 2 — C 3 

pilot  and  airframe  dynamics  to  develop  corresponding  actual  lateral 
accelerations  A^  r>  and  A^.  In  actual  missiles,  these  produced  acceler- 
ations are  not  equal  to  the  commanded  accelerations  due  to  time  lags, 
design  errors,  and  environmental  disturbances.  The  autopilot's  purpose 
is  to  manipulate  the  missile's  flight  control  surfaces  such  that  the 
produced  accelerations  equal  the  commanded  accelerations  as  quickly  and 
as  accurately  as  possible.  The  missile  in  this  study  uses  an  adaptive 
autopilot  (one  that  produces  uniform  response  over  varying  flight 
conditions)  to  accomplish  this  goal. 

To  develop  the  equations  of  motion  for  a missile,  certain  assump- 
tions must  be  made  about  the  missile's  airframe.  First  of  all,  the 
missile  is  assumed  to  have  no  inertial  angular  velocity  along  its 
roll  axis.  This  assumption  simplifies  the  set  of  dynamics  equations 
for  missile  motion.  Second,  the  airframe  is  assumed  to  be  shaped  like 
a cruciform  (see  Figure  9),  which  decouples  airframe  dynamics  into  two 
identical  sets  of  equations  - one  set  for  the  missile's  pitch  axis 
and  one  set  for  the  missile's  yaw  axis.  Since  most  missile  boosters 
have  a powerful,  but  short,  burn  time,  a constant  mass,  non-thrusting 
missile  is  the  third  assumption.  Finally,  small  angle  approximations 
arc  assumed  to  be  valid  for  angle  of  attack. 
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Under  these  assumptions,  the  four  equations  which  describe  the 


dynamics  of  the  missile  pitch  plane  are  (Ref  1:35;  6:14;  5:20-21;  10: 


Chap.  8,  p.3): 


AL2(U 


-V  { A j ( t ) - Q 3 ( t ) } 


Q,(t)  = 


m Q,(t)  +m  A3(t)  + m _ A ,( t ) 
q 3 a <5 


A 3 ( t ) 


Q,(t)  - la  A , ( t ) - 1 A 3 ( t ) 


A 3 ( t ) = -A  A 3 ( t ) + A Uj(t) 


where  A^  9 = missile  produced  acceleration  in  the  b-  direction 


(ft/ see2 ) 


= missile  velocity  assumed  to  be  in  the  bj  direction 


( ft/sec ) 


A 3 ( t ) = missile  angle  of  attack,  rotation  in  the  b3  direction, 


(rad) 


03(t)  = missile  pitch  rate  in  the  b3  direction  (rad/sec) 


A 3 ( t ) = control  surface  deflection,  rotation  in  the  b3  direction 


(rad) 


U3(t)  = control  command,  rotation  in  the  b3  direction  (rad) 


-A  = actuator  response  pole  (sec  ') 


m » m j m * 
q a 6 


1^,1  = missile  stability  derivatives  (sec  1 ) 


If  Q j ( t ) , A2 (t ) , A 2 ( t ) , and  U 2 ( t ) arc  defined  along  the  -b2  axis,  vector 


relationships  for  the  yaw  plane  are  identical  to  the  pitch  plane.  The 


four  equations  for  the  missile  yaw  plane  are 


AL3  = -VA’(t)  - Q*(U) 
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02 (t)  = m Q 2 ( t ) + 

q 

m A2(t)  + m.  A 2 ( t ) 

01  6 

(24) 

A 2 ( t ) = 0 2 ( t ) - 1 

a 

A 2 ( t ) - 1.  A j ( t ) 

(25) 

A 2 ( t ) = -X  A 2 ( t ) + 

x u2(t) 

(26) 

where  A^  = missile  produced  acceleration  in  the  b3  direction 
(ft/sec  ) 

Q 2 ( t ) = missile  yaw  rate  in  the  -b2  direction  (rad/sec) 

A2(t)  = missile  angle  of  attack,  rotation  in  the  -b2  direction 
( rad) 

A 2 ( t ) = control  surface  deflection,  rotation  in  the  -b2  direction 
( rad ) 

U2(t)  = control  surface  command,  rotation  in  the  -b2  direction 
(rad) 

The  conti’ol  commands,  U2(t)  and  U3(t),  are  modeled  as  a function  of 
commanded  accelerations,  pitch  rate,  and  produced  accelerations: 


U3(t) 

= K6 

Aca(t) 

- "•  AL2(t>  - 

hl 

Q 3 ( t ) 

(27) 

u2(t) 

= K6 

Aca^ 

- II,  AL3(t|  - 

hi 

Q2(t) 

(28) 

where  = autopilot 

gain 

in  bj 

direction,  yet 

to 

be  defined 

(sec2/ft) 

H2  = autopilot 

gain 

in  bj 

direction,  yet 

to 

be  defined 

(sec2/ft) 

hj  = scalar  adaptive  autopilot  gain,  yet  to  be  defined  (sec) 

By  taking  the  derivative  of  equation  (23),  substituting  in  equations 
(24)  and  (25),  and  performing  some  algebraic  manipulation,  equations 
(19),  (20),  (21),  (22),  and  (27)  can  be  formed  into: 
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Similarly,  equations  (23),  (24),  (25),  (26),  and  (28)  can  be  formed 
into : 


AL3(t) 

02 (t)  = 

A,  (t) 


r -( 1 +1!  2 XV  1 ) (V  1 -n  j XV  1 ) -(XV  1 )1  [a  (t) 

2 m 6 m a 1 m * m * ! I i % 


(m  /VI  ) 
a m a 

-H,  A 


(m-(ml/l  ))  02(t) 

q a 6 a 


A. 

d 


In  an  adaptive  autopilot,  the  autopilot  gains  are  varied  to 
maintain  a specific  missile  response.  If  actuator  dynamics  are  much 
quicker  than  airframe  dynamics,  actuator  dynamics  can  be  neglected. 
The  adaptive  controller  is  designed  so  that  the  missile  response  is 
essentially  second  order  of  the  form: 


31 


where  w = natural  frequency  (rad/sec) 
t,  = damping  ratio 

To  obtain  the  second  order  response,  h j , H2,  and  K must  equal 

6 


(Ref  5:26-27) 
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The  stability  derivatives  are  determined  by  a cubic  fit  to  actual 
missile  data  provided  by  the  Air  Force  Avionics  Laboratory.  A specific 
second  order  response  is  obtained  when  u>n  and  c,  are  specified.  For 
this  study,  = 7.07  radians  per  second,  and  z,  = .707:  realistic 
values  that  result  in  minimum  settling  time  (Ref  10:3). 

The  inertial  angular  velocity  of  the  missile,  is  equal  to  the 
sum  of  the  pitch  and  yaw  inertial  angular  velocities,  since  roll  is 
assumed  to  be  zero: 

Wfe  = 02  + Q3  (35) 


W,  = w, 

-b  by 


where  = missile  inertial  angular  velocity  in  the  i_,  direction 

- missile  inertial  angular  velocity  in  the  j_2  direction 
= missile  inertial  angular  velocity  in  the  i3  direction 
The  orientation  of  the  missile  body  frame  in  terms  of  the  inertial 
frame  is  defined  to  be: 


b,  = C^r 1 o 0]T 


b2  = C.[0  1 0] 

— 1 

b.  = Cb[0  0 l]1 
— 3 i 


(37) 

(38) 

(39) 


where  C.  is  the  direction  cosine  matrix  from  i to  b frame. 

l 

Similar  to  equation  (13),  the  dynamics  of  the  direction  cosine  matrix 
are : 


„b  b ,,ik 

pC.  = -C.  W., 

‘l  l lb 


(40) 


where 


p = first  derivative  with  respect  to  time 


wfj  = 

lb 


0 

-cou 

bz 

0), 

by 

W, 

bz 

0 
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5° 
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-uv 

. by 

0V 

bx 
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Integration  of  equation  (40)  specifies  the  orientation  of  the  b frame. 
The  linear  acceleration  of  the  missile  is  made  up  of  three  components: 

1.  ~ the  produced  acceleration  in  the  b2  direction  (ft/secJ) 

2.  Aj ^ - the  produced  acceleration  in  the  b3  direction  (ft/secJ) 

3.  A - the  acceleration  due  to  drag  opposite  the  velocity's 

direction  (ft/sec* ) 
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The  first  two  accelerations  have  been  specified.  The  third  must  still 
be  defined. 


The  acceleration  due  to  drag  is  dependent  upon  the  magnitude  of 
missile  velocity  as  well  as  the  magnitude  of  produced  lateral  accelera- 
tions (Kef  1:38-39) 


\ = y, 

D 2 1 in 


c V2 
D m 


('ll) 


where  p = air  density  (slug/ft3) 

(m/s)  = missile  mass  to  reference  area  ratio  (slug/ft2) 
c = coefficient  of  drag. 

The  coefficient  of  drag  is-  approximated  by 
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(42) 


where  MA.CU  = speed  of  sound  (ft./sec) 

c = stability  derivative 
na 

Aj  = total  produced  acceleration  (ft/sec2) 

This  totally  specifics  the  linear  acceleration  of  the  missile. 

The  linear  acceleration  of  the  missile  is  integrated  to  provide 
linear  velocity  and  position  information.  Along  with  the  orientation 
of  the  missile's  body  frame  and  seeker  frame,  the  missile  is  totally 
modelled. 


Target  Model 

The  target  model  is  composed  of  two  parts  - the  tracker  and  the 
target's  kinematics.  The  tracker  provides  line  of  sight  measurements 
every  0.02  second:.,  as  required  by  each  extended  Kalman  filter.  The 
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target's  kinematics  produces  various  maneuvers  which  in  turn  evoke  a 
range  of  missile  responses,  which  tests  the  filter's  ability  to  provide 
accurate  state  estimates  under  different  scenarios. 

The  tracker  part  of  the  target  model  resembles  a typical  radar 
used  by  fighter  aircraft.  It  has  the  capability  of  measuring  line  of 
sight  orientation  as  a function  of  two  angles.  The  four  other  avail- 
able measurements  are:  line  of  sight  inertial  angular  velocity  in 
two  components,  missile  range,  and  range  rate.  Each  measurement  is 
simulated  by  corrupting  the  truth  model's  true  value  of  these  quantities 
with  an  appropriate  strength  random  noise.  It  is  assumed  that  measure- 
ment noises  can  be  adequately  modeled  by  a first  order  Gauss-Markov 
process  combined  with  a constant  strength  white  Gaussian  noise 
(Ref  5:27-31).  It  is  also  assumed  that  the  tracker  part  is  symmetrical, 
resulting  in  identical  noise  statistics  for  both  angle  measurements, 
and  identical  noise  statistics  for  both  angular  velocity  measurements. 
The  noise  statistics  are  obtained  from  butter,  the  Air  Force  Avionics 
Laboratory,  and  Northrop;  and  are  presented  in  Table  II  (Ref  5:3). 

The  target's  kinematics  part  of  the  target  model  is  a simple  set 
of  equations  for  linear  acceleration.  Since  each  extended  Kalman 
filter  will  consider  only  the  inertial  motion  of  the  missile,  realistic 
modeling  of  target  kinematics  is  not  crucial.  What  is  necessary  is 
a set  of  realistic  missile  responses  that  will  test  each  extended 
Kalman  filter  over  a wide  range  of  scenarios. 

The  linear  acceleration  equations  are: 


l> 

—3 

II 

-Kj  a>*  cos  w ^ 

(43) 

— T2  = 

-K„  w*  sin  u>Tt. 

(44) 
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Sigmas  .and  Time  Constants  for  Measurement  Noise 


Measure 

Sigma 

Time  Constant 

RANGE 

Uncorrelated 

Correlated 

11.7  ft 

10.0  ft 

0.5  sec 

RANGE  RATE 

Uncorrclated 

Correlated 

7.0  ft/sec 

4.242  ft/sec 

1 .0  sec 

LINE  OF  SIGHT 

Angular  Velocity 
(Both  components) 

Uncorrelated 

Correl ated 

0.001745  rad/sec 

0.0008726  rad/sec 

10.0  sec 

LINE  OF  SIGHT 

Angular  Orientation 
(Both  angles) 

Uncorrclated 

Correlated 

0.00126  rad 

0.00168  rad 

0.5  sec 

At3  = — K * w*  sin(uTti  - .76)  (45) 

where  K2,  K ,, , j<6  = linear  constants  in  the  i , , i2,  and  i3  directions 
respectively  (ft) 

= scalar  constant  for  angular  rate  (rad/sec) 

-Tl’  — T2  ’ — T3  = ^-arf>e^  l]near  accelerations  in  the  _i , , j_2  , and  _i_3 


directions  respectively  (ft/secJ) 

t.  = time  (sec) 
i 


The  phase  term,  (.76),  of  equation  (45)  insures  that  the  target's  motion 


is  not  planar.  Appropriate  integration  of  equations  (45)  through  (45) 
produces  target  velocity  and  position.  Initial  velocity  conditions  are: 


= K, 

(46) 

— T1 

— T2 

II 

1 =* 

+ K„  wT 

(47) 

— T3 

= Ks 

+ K6  id  sin  ( .76) 

(48) 

where  K,,  K3,  Ks  = linear  velocity  constants  along  the  i 3 , i2,  and  i3 
directions  respectively  (ft/sec) 

V , V , V = target  linear  velocities  along  the  i_,  , i_2 , and  _i_3 
directions  respectively  (ft/sec) 

The  initial  target  position  is  the  origin  of  the  i frame.  A set  of 
constants,  K,  through  Ks,  as  well  as  an  w^,  determine  a specific  target 
trajectory  and  are  referred  to  as  a K set.  Four  trajectories  are 
available  to  test  each  extended  Kalman  filter.  The  K set  parameters 
are  listed  in  Table  III.  Trajectories  are  shown  in  two  dimensions  in 
Figures  10-A  through  10-D. 

Before  the  trajectories  are  numerically  compared  a key  concept 
must  be  presented.  The  missile  model  developed  in  this  chapter  is  a 
full  six  degree  of  freedom  model.  It  accurately  portrays  the  roll  that 
is  induced  by  conservation  of  momentum  when  a missile  performs  a turn. 
To  demonstrate  this  effect,  suppose  that  a missile  turns  with  respect 
to  the  inertial  frame  as  shown  in  Figure  11.  Since  the  missile  is 
flying  in  free  space,  the  b frame  (missile)  is  not  constrained  to  any 
orientation  with  respect  to  the  i frame,  i.e.,  the  vertical  tail  fin 
is  not  cons! rained  to  remain  vertical  as  the  missile  turns.  If  the 
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TABLF  111 


1 


K Set  Parameters 


K Set  1 

K Set  2 

K Set  3 

K Set  4 

K, 

100 

0 

850 

500 

-2000 

0 

200 

2864.51 

K, 

200 

700 

100 

800 

K k 

1000 

500 

200 

0 

k5 

0 

750 

250 

0 

k6 

0 

-900 

-590 

0 

0) 

0.4 

0.4 

0.6 

0.4 

angular  velocity  vector'  of  the  turn,  T,  is  broken  into  its  b frame 
components,  Tj  and  T5 , then  T,  is  along  the  bj  axis,  and  T5  is  in  the 
(b,  , i2)  plane  (see  Figure  12).  Tj  causes  the  b frame  to  rotate  with 
respect  to  inertial  space,  i.e.  the  missile  rolls.  Thus,  T5  appears 
to  rotate  around  the  missile  to  an  observer  on  the  missile  (theorem  of 
Coriolis),  yet  always  lies  in  the  (bj , i2)  plane.  This  vector,  Ts , 
is  generated  by  the  missile  when  the  pitch  and  yaw  inertial  angular' 
velocities  of  the  missile  are  appropriately  periodic  and  out  of  phase. 
Thus,  what  dynamically  appears  to  be  a rotating  angular  velocity  vector 
to  the  missile  is  an  inertial  turn  as  depicted  in  Figure  11.  Because 
of  the  conservation  of  momentum,  the  missile  rolls  as  it  turns 
(Hef  14:113-118).  These  effects  are  modelled  in  the  truth  model  to 
insure  that  this  roll,  which  is  not.  modeled  by  the  filters,  does  not 
produce  adverse  state  estimation  errors. 
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Missi le 

Side  View 


Fig.  10— A . K Set  One  Trajectory 
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Fig.  10-D.  K Set  Four  Trajectory 


4?. 
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The  amount  of  induced  missile  roll  is  one  of  several  factors  that 
distinguish  each  K set.  Other  factors  include  missile  lateral  acceler- 
ation, missile  lateral  acceleration  rate,  and  line  of  sight  movement. 

The  line  of  sight  movement  is  defined  to  be  that  angle  which  the  line 
of  sight  vector,  r makes  with  the  (_i_,  , j_2 ) plane.  (This  definition 
is  chosen  since  the  line  of  sight  is  contained  by  the  (ij,  i2)  plane 
at  the  start  of  each  trajectory.)  This  angle,  along  with  the  missile 
roll,  gives  some  measure  as  to  how  close  the  scenario  resembles  a 
scenario  confined  to  a single  plane.  The  four  trajectories  are  compared 
in  Table  IV. 

No  other  trajectories  are  used  for  testing.  It  is  understood  that 
these  four  trajectories  do  not  test  for  all  possible  factors  that  may 
affect  the  extended  Kalman  filters,  such  as  a vertical  line  of  sight. 

K set  four  approaches  a vertical  line  of  sight  to  within  .04  radians. 

In  Cusumano  and  DePonte's  filter  (Chapter  III),  a vertical  line  of 
sight  produces  an  undefined  equation  if  a change  of  states  (V  to  V'^  ) 
and  state  equations  is  not  accomplished.  The  filter  accomplishes  this 
change  automatically.  In  the  11  state  filter  (Chapter  IV),  the 
restriction  placed  on  the  12  axis  (12  must  lie  in  the  ( i x , i3)  plane) 
docs  not  uniquely  define  the  1 frame  when  the  line  of  sight  is  vertical. 
However,  it  is  felt  that  they  cover  enough  factors  to  provide  insights 
to  filter  performance.  The  computer  program  that  implements  both 
truth  models  is  Subroutine  Traj  in  Appendix  D. 
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Missile  Response  Comparisons  of  Trajectories 


Maximum  Magnitude 
Pitch  Acceleration 
( ft./sec 7 ) 


610 


K Set  2 


270 


K Set  3 


720 


K Set  4 


770 


Maximum  Magnitude 
Yaw  Acceleration 
(ft / sec 7 ) 


110 


384 


420 


100 


Maximum  Pitch 
Acceleration  Rate 
(ft/sec  Vsec ) 


4 50 


310 


840 


580 


Maximum  Yaw 
Acceleration  Rate 
( ft/ sec  2/sec ) 


Maximum  Missile 
Roll  (degrees) 


40 


0.8 


180 


30 


420 


27 


110 


1.5 


Maximum  Line  of 
Sight  Movement 
( degrees ) 


1.0 


13 


21 


0.9 


Dominant  Quality 


Approximates 

Two 

Dimensional 


Low 

Acceleration 


High 

Accelerat i on 
Rate 


Cusumano  G 
DePonte 
Trajectory 


III.  Extension  of  Two  Dimensional  Filter 

Introduct ion 

The  research  performed  by  Cusumano  and  DePonte  shows  that  an 
extended  Kalman  filter,  based  upon  a refined  missile  accel oration  model, 
is  an  effective  aid  to  a fire  control  system  under  two  dimensional 
conditions  (Ref  1).  Their  two  dimensional  filter  uses  eight  states  to 
provide  real  time  estimates  of  range,  range  rate,  azimuth  angle,  and 
missile  acceleration.  From  these  estimates,  two  dimensional  pointing 
and  tracking  become  more  precise.  However,  the  question  remains  as  to 
the  validity  of  the  two  dimensional,  i.e.  planar  case,  filter  in  a 
three  dimensional  world. 

At  first  glance,  it  can  be  argued  that  a two  dimensional  filter 
should  be  valid  under  three  dimensional  conditions.  The  proportional 
navigation  law  employed  by  the  missile  attempts  to  null  any  inertial 
angular  motion  of  the  line  of  sight  vector.  Thus,  the  scenario  should 
reduce  to  perturbations  about  a nominal  plane,  perhaps  allowing  the 
nominal  plane  to  rotate  appropriately.  To  test  this  hypothesis,  three 
three-dimensional  applications  of  the  Cusumano  and  DePonte  eight  state, 
two  dimensional,  extended  Kalman  filter  (hereafter,  the  2D  filter)  arc 
proposed.  These  three  proposals  are:  a moving  reference  plane  2D 
filter;  two  fixed,  2D  filters  with  four  measurements;  and  two  fixed,  2D 
filters  with  two  measurements.  It  is  recognized  that  other,  perhaps 
better,  proposals  exist  that  are  not  considered. 
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Before  the  three  proposals  are  presented,  the  assumptions  and 
limitations  of  the  2D  filter  must  be  understood.  The  eight  states  of 
the  2D  filter,  using  the  notation  developed  by  Cusumano  and  DePonte, 
are  (Ref  1:43-72) 

0 - line  of  sight  angle,  as  seen  by  the  target,  in  the  XY  plane 
R - line  of  sight  range  in  the  XY  plane 
R - line  of  sight  range  rate  in  the  XY  plane 

- X velocity  of  the  missile 

mx 

A(  - lateral  acceleration  of  the  missile  in  the  XY  plane 
(These  first  five  states  arc  depicted  for  an  arbitrary  time  instant  in 
Figure  13.) 

n - missile's  proportional  navigation  constant 
t - time  lag  of  filter's  first  order  lag  missile  model 
(m/s)  - ratio  of  missile  mass  to  effective  surface  area  (for  drag 
computations) 

(These  three  parameters  are  hereafter  referred  to  as  states.) 

The  2D  filter  uses  measurements  of  0 , R,  and  R.  In  the  development 
of  these  eight  states,  Cusumano  and  DePonte  assume  that  the  filter's 
XY  plane  is  inertially  fixed  and  horizontal.  All  proposed  three 
dimensional  applications  of  the  2D  filter  violate  this  assumption  to 
some  degree,  malting  them  inherently  less  accurate  than  the  two  dimen- 
sional application. 

F i rst  Proposal 

In  the  first  proposal,  the  2D  filter's  XY  plane  is  defined  by  the 
gravity  vector  and  the  line  of  sight  vector.  This  relates  o to  the 
elevation  angle.  However,  the  XY  plane  is  no  longer  an  inertial  plane, 
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should  he  modified  to  account  for  gravity,  since  gravity  effects  may 
be  significant.  Unfortunately,  no  estimate  of  azimuth  angle  is  avail- 
able, so  this  application  is  not  investigated. 

Second  Proposal 

The  second  three  dimensional  application,  which  is  similar  to  the 

third,  is  called  the  double  filter.  Two  2D  filters  are  used  - one 

whose  XY  plane  is  the  inertial  (J_, , i2)  plane  (X  2D  filter);  the  other 

whose  XY  plane  is  the  inertial  (i2,  i3)  plane  (Z  2D  filter)  (see 

Figure  15).  Eacli  filter  performs  estimates  on  the  planar  projections 

of  the  3-D  scenario.  Thus,  the  inertial  orientation  of  the  double 

filter's  states  remains  fixed  throughout  the  scenario.  To  avoid 

modification  of  established  computer  software,  gravity  effects  are 

ignored.  Since  most  K set  trajectories  induce  missile  accelerations 

greater  than  10  g's,  it  is  assumed  that  gravity  errors  will  be  small 

enough  sucli  that  other  error  sources  can  be  discerned.  Had  this 

method  seemed  more  fruitful,  a more  proper  accounting  for  gravity 

effects  would  have  been  made  in  the  filter.  The  inertial  orientation 

of  the  line  of  sight  vector  can  be  expressed  as  a function  of  the  angle 

state  from  each  2D  filter,  0,„  and  0 . Therefore,  the  double  filter 

IX  ] /» 

is  capable  of  providing  estimates  of  the  line  of  sight  azimuth  and 
elevation  angles. 

There  is  one  drawback,  however.  The  target  radar's  measurements 
of  range  and  range  rate  are  not  direct  measurements  of  either  2D 
filter's  R and  R states,  since  the  line  of  sight  is  generally  not 
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coplanar  to  the  2D  filter  planes  (see  Figure  lf>).  (The  two  angle  states 
can  be  uniquely  defined  from  radar  azimuth  and  elevation  angles,  or  the 
radar  can  be  so  constructed  such  that  the  radar  angle  measurements 
correspond  directly  to  the  filter's  angle  states.)  Therefore,  these 
measurements  must  be  projected  into  the  filter  planes  by  an  appropriate 
transformation.  One  transformation  must  be  used  to  find  the  range  and 
range  rate  projection  into  the  X 2D  filter  plane;  another  transformation 
must  be  used  to  find  the  range  and  range  rate  projection  into  the  Z 2D 
filter  plane. 

These  transformations  require  knowledge  of  the  inertial  orientation 
of  the  line  of  sight  vector,  which  requires  the  angle  state  from  both  2D 
filters.  This  requirement  couples  the  X and  Z 2D  filters.  This  weakly 
coupled  system  may  yield  adequate  results,  but  observability  problems 
and/or  cross  coupling  of  errors  through  the  angle  states  are  a concern. 

To  avoid  these  potential  problems,  transformation  are  not  based  on  the 
double  filter's  estimate  of  line  of  sight  orientation.  Instead,  trans- 
formations are  initially  defined  from  measurements  and  held  constant 
(or  can  be  periodically  redefined).  Another  alternative,  which  is  the 
third  application,  is  to  avoid  R and  R measurements  entirely. 

In  the  simulation,  the  true  values  of  0 and  0 arc  used  to 
determine  the  three  dimensional  orientation  of  the  line  of  sight  vector, 
r j . (Tn  practice,  several  measurements  of  these  states  can  be 
averaged  to  determine  the  orientation  of  r . ) Next- , r,  ( i • pn-j.  ' 
into  each  2D  filter  plane  to  determine  the  proper  Iran  forma t • , • - 
stant  for  each  2D  filter.  The  range  and  range  rate  me  a urcr.ci  • . 

multiplied  by  the  transformation  constant,  yield  tin  R and  R • '■  . 

The  double  filter  is  then  initialized  with  the  transf • i;  ■'  *ti  < •»,  t 
and  allowed  to  estimate  the  states. 
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Difference  Between  Filler  Stoles  and 
Measurements  for  Double  Filter 


The  double  filler  with  four  measurements  is  first  tested  with 


trajectory  K set  one , which  is  the  closest  trajectory  to  two  dimensional 
motion.  Filter  states  are  initialized  with  zero  error,  and  tuning 
parameters  specified  by  Cusumano  and  DePonte  for  a two  dimensional  K 
set  four  trajectory  are  used  (Ref  2:328-329).  These  tuning  parameters 
are  chosen  as  the  best  available.  Extensive  2D  filter  testing  is  not 
accomplished  to  determine  ttie  best  tuning  parameters  for  each  trajec- 
tory due  to  time  limitations. 

Tire  line  of  sight  vector  is  initially  contained  in  the  X 2D  filter 
plane.  This  simplifies  analysis  to  one  2D  filter,  since  the  transfor- 
mation constant  for  the  X 2D  filter  is  one;  the  transformation  constant 
for  the  Z 2D  filter  is  zero;  and  the  transformations  are  held  constant 
throughout  the  test.  (Normal  implementation  would  initially  orient  the 
inertial  coordinate  frame  such  that  both  double  filters  would  use 
identical  transformation  constants.)  In  addition,  the  X 2D  filter's 
transformation  constant  is  at  its  smallest  sensitivity  to  transverse 
line  of  sight  movement.  Therefore,  if  the  X 2D  filter  cannot  perform 
adequately  under  tiiese  initial  conditions,  then  the  double  filter  is 
not  feasible.  The  converse  is  not  true,  since  the  double  filter  is 
being  tested  under  ideal  conditions. 

The  results  of  this  test  (which  arc  contained  with  all  other 
results  of  this  chapter  in  Appendix  C)  arc  compared  to  the  results 
obtained  by  Cusumano  and  DePonte  and  show  unacceptable  filter  perfor- 
mance (Ref  2:308-347).  Half  of  the  states,  including  two  of  the  four 

states  used  for  pointinp  and  tracking  (R  and  V ),  have  severe  biases 

mx 

(see  Figures  17,  18,  and  19).  Yet,  the  standard  deviations  of  the 
filter  state  estimates  arc  generally  less  than  the  filter's  estimate 
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Fir.  18. 


RANGE  DOUBLE  FILTER 


of  the  standard  deviations  and  compare  favorably  will  Cusumano  and 
DePonte's  results  (Ref  2:308-347)  (see  Figures  20,  21,  and  22).  This 
indicates  that  gravity  effects  (which  can  be  easily  modeled)  and/or 


measurement  transformation  errors  are  significant.  However,  it  is 
conceivable  that  under  the  K set  one  target  trajectory,  errors  are 
caused  by  improper  filter  tuning.  Cusumano  and  DePonte  note  that 
because  the  2D  filter  is  "optimally  tuned  for  a given  trajectory,  the 
robustness  observed  over  that  one  trajectory  may  not  be  observed  for 
other  scenarios  without  retuning  the  filter"  (Ref  1:118-119).  Therefore, 
to  insure  that  the  biases  are  not  caused  by  the  differences  in  trajec- 
tories, the  double  filter  is  tested  against  the  target  trajectory  used 
by  Cusumano  and  DePonte  - K set  four. 

When  the  double  filter  performs  state  estimates  on  a three  dimen- 
sional missile  attacking  the  K set  four  target  trajectory,  good 
state  estimates  occur  after  an  initial  transient  (see  Figures  23,  24, 
and  25).  The  comparison  of  filter  state  standard  deviations  to  the 
filter's  estimate  of  those  standard  deviations  shows  good  filter 
tuning  (see  Figures  26,  27,  and  28).  Therefore,  this  test  indicates 
that  the  double  filter  is  capable  of  aiding  a three  dimensional  tracking 
and  pointing  system,  but  its  tuning  is  sensitive  to  the  trajectory. 

Adaptive  tuning  may  overcome  this  problem. 

To  eliminate  the  effects  of  errors  in  the  transformation  constant, 
the  line  of  sight  vector  is  restricted  to  the  (i2,  i2)  plane  when  the 
target  flics  trajectory  K set  four.  This  is  accomplished  by  restricting 
missile  motion  to  the  ( i , , i2)  plane.  Thus,  the  line  of  sight  is 
always  in  the  2D  filter  plane.  The  results  from  this  test  are  almost 
identical  to  the  previous  test,  indicating  that  errors  in  the 
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Fig.  20. 


ANGLE  MEASUREMENT  SIGMAS  DOUBLE  FILTER 
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Fig.  21.  RANGE  SIGMAS  DOUBLE  FILTER 
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Fig.  22.  RANGE  RATE  SIGMAS  DOUBLE  FILTER 
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FiC.  23. 


ANCLE  MEASUREMENT  DOUBLE  riLTER 


FiC-  26.  RMCl  E MEASUREMENT  SfGMflS  DOUBLE  FILTER 
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transformation  constant  (when  the  line  of  sight  is  within  one  degree  of 
the  filter  plane)  have  little  effect  on  filter-  performance . The 
initial  transients  are  apparently  due  to  gravity  ( sec  Figures  29-3-t). 
However,  these  tests  are  inherently  two  dimensional,  with  transverse 
line  of  sight  motion  less  than  a degree.  The  double  filter  must  still 
be  tested  when  the  line  of  sight  vector  exhibits  greater  changes  in 
orientation,  such  as  with  the  K set  three  trajectory. 

The  K set  three  trajectory  produces  larger,  quicker  changes  to  the 
line  of  sight  orientation  than  do  the  other  K sets.  This  tests  the 
validity  of  the  transformation  constants.  Under  this  test,  the  double 
filter  encounters  computer  caused  numerical  difficulties  with  the  (m/s) 
variance  computations.  The  specific  values  of  the  filter  states,  up 
to  the  time  of  numerical  failure,  are  analyzed.  These  values  show 
that  when  the  line  of  sight  vector  rotates  transverse  to  the  2D  filter 
plane,  an  error  in  the  R and  R states  is  induced.  This  effect  is 
similar  to  the  changes  that  occur  to  a planar  projection  of  a rotating 
unit  vector  (see  Figure  35).  Note  that  when  the  unit  vector  rotates, 
derivative  information  of  its  projection,  i.e.  velocity  and  accelera- 
tion, is  also  affected.  To  understand  why  numerical  difficulties  are 
encountered,  the  2D  filter  is  analyzed. 

In  a two  dimensional  environment,  measurement  errors  in  G^,,  R,  and 
R (states  of  the  2D  filter)  are  appropriately  modeled.  In  a three 
dimensional  environment,  transverse  line  of  sight  movement  causes 
measurement,  errors  that  arc  not  modeled  by  the  filter  (see  Figure  36). 

The  measurements  arc  used  by  the  2D  filter  to  compute  the  linear 
and  angular  accelerations  of  the  line  of  sight  vector.  I'nmodelcd 
measurement  errors  arc  treated  as  a part  of  the  filter's  computed  line 
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Unit  vector  rotation  causes  a growth  in  projected  r 
and  a change  in  orientation. 


Fig.  36.  Summarized  Filter  Plane  Results  of  Figure  33 
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of  sight  accelerations.  In  this  case,  transverse  line  of  sight  motion 
induces  the  most  error  on  the  line  of  sight's  linear  acceleration  (as 
computed  by  the  filter).  To  see  the  effect  of  this  induced  error  on 
the  2D  filter,  a free  body  diagram  of  the  missile  is  constructed.  It 
reveals  that  the  filter's  estimate  of  missile  drag  and  lateral  accelera- 
tions must  directly  account  for  any  errors  in  the  line  of  sight 
acclcrations  as  computed  from  the  measurements  (see  Figure  37).  Filter 
tuning,  as  well  as  acceleration  vector  orientations,  determine  state 
sensitivities  to  errors  in  the  calculated  line  of  sight  accelerations. 

In  this  case  (m/s)  is  most  sensitive  to  induced  line  of  sight  linear 
acceleration  errors  since  (m/s)  is  used  to  compute  drag.  Therefore, 
the  filter's  (m/s)  variance  encounters  numerical  difficulties  when 
the  (m/s)  state  must  change  considerably  to  balance  the  filter's 
acceleration  model.  When  a similar  test  is  run  with  the  filter's  (m/s) 
state  constrained  to  its  true  value,  the  A variance  encounters 
numerical  difficulties,  confirming  this  analysis.  Therefore,  a constant 
transformation  constant  is  not  feasible.  Three  dimensional  evasion 
maneuvers  by  the  target  result  in  induced  acceleration  effects,  which 
are  unmodeled  by  the  filter  and  are  significant.  No  testing  of 
periodically  updated  transformation  constants  is  performed. 

Th i rd  Proposal 

The  final  three  dimensional  proposal  - the  double  filter  which 
processes  angle  measurements  only  - is  tested  against  K set  four.  This 
trajectory  is  again  chosen  to  avoid  possible  trajectory-caused  tuning 
problems.  In  this  test,  the  errors  in  the  R and  R state  estimates 
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(see  Figures  38,  39,  and  40).  The  standard  deviations  of  the  state 


estimates  are  generally  more  than  the  filter's  estimates  of  the  standard 
deviations,  indicating  a tuning  problem  (see  Figures  41,  42,  and  43). 
Yet,  because  this  filter  ignores  available  information , retuning  is 
not  accomplished,  allowing  more  time  to  be  devoted  to  the  development 
of  the  11  state  filter.  It  is  felt  that  even  with  retuning,  error 
levels  for  the  pointing-tracking  states  in  this  filter  would  be  too 
high. 
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IV.  Three  Dimensional  Filter  and  Model 

Introduction 

The  hardest  and  most  important  task  in  designing  a model  is 
choosing  a state  space.  A good  choice  of  states  can  produce  an  excel- 
lent filter;  a bad  choice  can  cause  problems  or  even  fail  completely. 
Generally,  the  problems  that  need  to  be  avoided  are  redundant  states 
and  a wide  eigenvalue  range  on  the  state  transition  matrix  (Ref  7,8). 
Previous  pointing  and  tracking  research  has  found  favorable  results 
with  a polar  coordinate  frame  state  space  (Ref  4,9). 

Many  pointing-tracking  systems  measure  more  than  line  of  sight 
orientation,  range,  and  range  rate.  Line  of  sight  inertial  angular 
velocities  can  also  be  measured  if  the  system  is  dedicated  to  one 
missile.  Cusumano  and  DePonte,  as  well  as  butter,  assume  that  one 
pointing-tracking  system  will  both  scan  for  oncoming  missiles  (scanner) 
and  provide  position-velocity  information  to  a fire  control  system 
(Ref  1:1,5:1-2,27).  Therefore,  their  filters  only  process  range, 
range  rate,  and  line  of  sight  orientation  information,  with  no  angular 
velocity  measurements. 

If,  however,  a remote  scanner  is  used  for  threat  evaluation,  each 
weapon  system  can  have  a colocated  pointing-tracking  system  dedicated 
to  tracking  one  missile.  This  avoids  transfer  alignment  errors  and 
provides  more  measurements  to  the  extended  Kalman  filter,  which 
increases  pointing-tracking  accuracies.  Therefore,  the  designed  model 
should  be  capable  of  processing  range,  range  rate,  and  line  of  sight 
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orientation,  to  take  advantage  of  any  and  all  available  information. 


Fi Iter  Slate  Space 

Based  upon  the  previous  ideas,  the  filter  state  space  is  chosen 
in  polar  coordinates.  Eleven  states  completely  describe  the  system. 
These  states  are: 

0i  - first  Euler  rotation  from  inertial  frame  to  line  of  sight 
frame  (rad) 

q2  - second  Euler  rotation  from  inertial  frame  to  line  of  sight 
frame  (rad) 

o)1  - inertial  angular  velocity  of  line  of  sight  frame,  along 
first  line  of  sight  frame  axis  (rad/sec) 

co2  - inertial  angular  velocity  of  line  of  sight  frame,  along 
second  line  of  sight  frame  axis  (rad/sec) 

- missile  position  relative  to  target  position  in  line  of 
sight  frame  (kiloft  = 103  ft) 


tm 


LI 


L2 


nf 

Tf 

(m/s)f 


rate  of  change  of  R as  observed  in  the  line  of  sight 
frame  (kiloft/sec) 

lateral  acceleration  of  missile  along  first  missile  velocity 
frame  axis  (kiloft/sec2) 

lateral  acceleration  of  missile  along  second  missile  velocity 
frame  axis  (kiloft/sec2) 

proportional  navigation  constant,  as  estimated  by  the  filter 
first  order  lag  time  constant  for  filter  model  of  missile 
response  (sec) 

mass  to  effective  surface  ratio  of  missile,  as  modeled  by 
the  filter  (slug/kiloft* ) 
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The  units  of  length  are  chosen  to  avoid  computer  numerics  problems  in 
computing  the  Kalman  filter  gains.  The  three  coordinate  frames  inherent 
with  this  state  space  are:  inertial  (i),  true  line  of  sight  (1),  and 
missile  velocity  (v).  These  frames  and  the  states  associated  with 
them,  are  depicted  in  Figure  44.  Euler  rotations  relate  one  frame  to 
the  other.  These  relationships  are  depicted  in  Figures  45  and  46.  A 
complete  derivation  of  state  equations,  as  well  as  the  derivation  of  a, 
and  a2  (the  Euler  rotations  from  the  v frame  to  the  1 frame),  is 
contained  in  Appendix  B. 

In  ihe  derivation,  the  state  space  equations  for  w,,  w2 , and  R 
are  developed  from  the  theorem  of  Coriolis.  Missile  velocity,  as 
measured  by  the  target's  pointing-tracking  system,  is  related  to  the 
missile  velocity  as  expressed  in  the  v frame,  to  obtain  expressions  for 
the  Euler  rotation  angles  at  and  a2.  The  missile's  drag  and  lateral 
accelerations,  which  are  modeled  in  the  v frame,  are  transformed  to 
the  1 frame  via  and  a2.  Missile  acceleration  due  to  gravity  is 
transformed  from  the  i frame  to  the  1 frame  via  G1  and  02  - two  of  the 
eleven  filter  states.  Gravity,  drag,  and  lateral  accelerations  are 

• 

combined  in  the  1 frame  to  produce  state  equations  for  Uj , w2 , and  R 
through  the  theorem  of  Coriolis.  The  state  equations  for  ©j,  02,  and 
R are  developed  directly  from  state  definitions.  A first  order  lag, 
proportional  navigation  missile  model  is  used  for  the  Aj  and  h state 
equations.  Finally,  white  Gaussian  noise  of  appropriate  strength  is 
employed  to  model  the  parameters  n^, , t„,  and  (m/sl^.. 

This  three  dimensional  filter  model  contains  four  assumptions: 

1.  The  actual  missile's  guidance  scheme  approximates  propor- 
tional navigation. 
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Fig.  A A . The  Three  Filter  Frames 


2.  The  actual  missile  is  non-thrusting. 

3.  Actual  pitch  and  yaw  missile  responses  are  adequately 


modeled  by  two  independent,  symmetrical  (identical),  first 
order  lag  networks. 

4.  The  actual  missile's  pitch  axis  is  constrained  to  the 
(1,,  13)  plane;  while  simultaneously,  the  12  axis  is 
constrained  to  the  (i,,  i3)  plane. 

The  first  two  assumptions  limit  the  scope  of  the  problem.  The  third 
assumption  is  shown  to  be  adequate  in  the  literature  (Ref  1).  The 
fourth  assumption  must  still  be  demonstrated. 

In  reality,  the  fourth  assumption  is  an  approximation  that  is  made 
to  reduce  the  complexity  of  the  filter  equations.  Analysis  shows  that 
if  the  actual  missile's  response  is  symmetrical  (assumption  3),  then 
the  angle  between  the  actual  missile's  response  planes  and  the  corres- 
ponding response  planes  in  the  filter's  model  does  not  introduce  error 
to  the  model  provided  roll  axes  of  2 missile  models  remain  colinear. 

This  is  not  true  for  asymmetrical  missiles,  nor  is  it  true  if  the  angle 
is  not  constant.  Under  the  assumptions  of  this  thesis,  there  are  two 
ways  the  angle  can  change  - through  inertial  missile  roll  and/or 
through  inertial  model  roll  (see  Figure  47). 

Inertial  missile  roll  is  a physical  phenomena  associated  with 
missiles  and  is  composed  of  two  quantities  - roll  stablization  and 
induced  missile  roll.  Roll  stabilization  is  a constant,  or  near  con- 
stant, inertial  angular  velocity  along  the  missile's  roll  axis  that  is 
present  when  the  missile  is  flying  a straight  line.  It  is  assumed  to 
be  zero  for  the  purposes  of  this  thesis.  Induced  missile  roil,  which  is 
also  an  inertial  quantity,  is  zero  except  when  the  missile  performs  a 
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turn  (see  Chapter  II,  Target  Model).  The  effects  of  induced  missile 
roll  are  assumed  to  be  negligible  to  reduce  the  complexity  of  the 
filter  equations.  The  truth  model,  however,  models  induced  missile 
roll  to  insure  that  this  assumption  is  valid. 

Inertial  model  roll  is  a modeling  error  induced  when  the  angle 
between  the  missile  centerline  and  the  line  of  sight  changes.  It  is 
caused  by  the  constraint  on  the  missile's  pitch  axis,  i.e.  assumption  A 
of  the  filter  model.  It  can  be  eliminated  if  al  and  a2  arc  defined  to 
be  Euler  rotation  angles  from  the  v frame  to  the  i frame,  rather  than 
from  the  v to  1 frames.  However,  the  mathematical  relationships  for 
the  state  model  become  much  more  complex  under  this  new  definition. 

In  addition,  preliminary  analysis  indicates  minimal  adverse  effects 
from  model  roll  (see  Appendix  B).  Therefore  and  az  are  defined  to 
be  Euler  rotation  angles  from  the  v to  1 frame  to  simplify  the  filter 
equations . 

Filter  Tests 

The  three  dimensional  filter  is  tested  against  each  K set  trajec- 
tory. The  complete  computer  program  (except  a matrix  inversion  routine 
called  MINV)  that  is  used  for'  the  tests  is  contained  in  Appendix  D. 

A complete  set  of  statistical  plots,  as  well  as  tuning  specifications, 
is  contained  in  Appendix  E. 

For  each  test,  the  filter  states  are  initialized  to  the  true 
values.  The  initial  true  values  for  0,,  02,  w,,  u,,  R^m,  and  R .re 
calculated  from  the  missile's  and  target's  initial  position  and 
velocity.  Missile  lateral  accelerations  are  set  equal  to  zero.  The 
parameters  n^  and  (m/s)^,  arc  set  to  the  values  used  by  the  truth  model. 
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tj,,  however,  is  set  to  the  value  that  hopefully  best  approximates  the 
missile's  response  characteristics.  In  this  thesis,  the  true  value  is 
set  at  0.7  seconds,  causing  initial  transients  in  the  filter's  estimate 
of  Tj,.  These  transients  are  characteristic  of  an  initial  state  error. 

In  Cusumano  and  DePonte's  thesis,  the  true  value  is  estimated  at  0.85 
seconds  (Ref  1:85).  Since  the  missile  truth  model  that  is  used  in  this 
thesis  is  an  extension  of  Cusumano  and  DePonte's  missile  truth  model, 
the  true  value  of  should  be  0.85  seconds.  Time  constraints  on  this 
thesis  prevent  correction  of  this  error. 

The  tuning  parameters  for  all  tests  are  identical  and  are  obtained 
by  tuning  the  11-state  filter  for  the  K set  one  trajectory.  Due  to 
time  limitations,  the  filter  is  not  fine  tuned  for  maximum  performance 
on  K set  one  (but  reasonably  good  tuning  is  achieved),  nor  is  any 
tuning  attempted  with  the  other  trajectories.  Therefore,  the  filter 
is  not  fully  designed  for  use  in  a three  dimensional  environment.  It 
is  felt  that  these  tests  will  provide  insights  and  indications  of 
potential  filter  accuracies  and  problem  areas,  as  well  as  insights  for 
final  tuning. 

The  tuning  philosophy  used  to  tune  the  11-state  filter  is  identical 
to  the  philosophy  used  by  Cusumano  and  DePonte  (Ref  1:74-76).  Basically, 
the  values  chosen  for  the  filter's  measurement  noise  model  are  derived 
from  the  tracker  radar's  performance  specifications.  The  pseudo-noise 
strength,  and  the  initial  filter  covariance  P0,  are  varied  until 

the  variance  of  the  filter's  state  estimate  is  less  than  the  filter's 
estimate  of  the  variance  for  that  state.  This  insures  that  the 
filter's  confidence  in  its  state  estimates  reflect  the  estimate's  true 
statistical  nature.  After  this  variance  matching  is  accomplished, 
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noise  strengths  are  further  increased  to  remove  any  residual  biases 


in  the  state  estimates. 
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V.  Results  and  Recommendations 


Resul ts 

The  11-state  filter  provides  good  state  estimation  for  the  three 
dimensional  K set  one  trajectory.  Its  results  are  compared  to  the 
corresponding  results  obtained  by  Cusumano  and  DePonte  for  a two 
dimensional  system  (Ref  2).  Better  accuracies  in  the  pointing-tracking 
states  (©,,  02,  Uj , m2 , R^m , and  R ) are  achieved  probably  due  to 
the  additional  angular  velocity  measurements.  Accuracies  similar  to 
Cusumano  and  DePonte’s  are  achieved  for  the  lateral  acceleration  and 
parameter  states.  It  is  at  this  level  of  performance  that  filter 
tuning  is  stopped,  since  time  limitations  prevented  further  investiga- 
tion. Therefore,  this  performance  is  not  necessarily  the  best  that 
the  filter  can  do,  although  enough  tuning  was  accomplished  to  show  that 
it  is  close. 

To  test  the  robustness  of  the  K set  one  filter  tuning,  the  K set 
one  tuned  filter  is  tested  against  the  X sets  two,  three,  and  four 
trajectories.  In  each  of  these  tests,  the  filter's  estimation  of  the 
pointing-tracking  states  is  degraded,  yet  still  within  the  accuracies 
demonstrated  by  Cusumano  and  DePonte  (Ref  2),  making  these  states 
usable  in  an  aided  pointing-tracking  system.  The  estimates  of  the 
lateral  acceleration  states  and  their  corresponding  parameters  (n^. 
and  -r^l  are  more  seriously  degraded  makiiy  them  unusable  for  threat 
evaluation  or  threat  avoidance  in  some  trajectories.  Close  inspection 
of  the  results  reveals  that  the  n^,  and  -t^.  parameters  arc  allowed  to 
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vary  too  much  too  quickly  due  to  a rattier  large  value  for  ttie  come:  pon- 
ding pseudonoise  strength.  Thus,  the  filter  has  less  confidence  in  its 
estimate  of  these  parameters  than  the  statistics  show  is  warranted,  i.e. 
the  filter  is  too  conservative  (see  Appendix  E).  For  K set  one  (and 
Cusumano  and  DePonte's  filter  versus  their  trajectory),  this  large 
pseudonoise  strength  is  appropriate  since  good  estimation  is  achieved. 
But  for  other  trajectories,  this  conservative  tuning  degrades  the 
filter's  performanace . 

The  parameters  n^.  and  t_  are  both  used  to  compute  the  lateral 
accelerations  of  the  missile.  If  an  error  is  present  in  one  of  the 
parameter  estimates  (such  as  t^) , the  other  is  affected.  Since  each 
trajectory  affects  the  lateral  accelerations  of  the  missile  differently, 
the  parameter  interaction  is  different  for  each  trajectory.  For  K set 
two,  for  instance,  the  effects  of  the  n^.  and  parameter  errors  on 
the  lateral  acceleration  estimates  tend  to  add,  causing  a serious 
degradation  in  the  filter's  estimate  of  lateral  accelerations.  At  the 
end  of  the  trajectory,  this  degradation  becomes  important  enough  to 
"pull"  some  of  the  pointing-tracking  states  away  from  their  true  value. 
For  K set  three,  the  effects  of  these  parameter  errors  tend  to  cancel. 
Thus,  lateral  acceleration  estimates  arc  better  than  in  K set  two. 
Different  tuning  specifications  are  necessary  to  stabilize  the  perfor- 
mance of  the  n^.  and  t^.  filter  states.  Unfortunately,  time  limitations 
prevent  the  accomplishment  of  any  additional  tuning  tests. 

These  tests  demonstrate  the  filter's  robustness  for  the  pointing- 
tracking  states.  Pointing  and  tracking  accuracies  equal  to  or  better 
than  those  achieved  by  Cusumano  and  DePontc  are  demonstrated  over  four 
trajectories.  The  performance  of  the  parameter  states  indicate  that 
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different  parameter  psoudono i se  values  are  required  to  increase  the 


- 


accuracies  of  the  n^.,  t^,  , and  state  estimates  against  K sets 

two,  three,  and  four  trajectories.  Further  tuning  .and  testing  of  this 
filter  is  required  to  determine  if  one  appropriate  set  of  tuning 
specifications  will  provide  adequate  performance  of  these  states  for 
all  trajectories. 

Kecommondat i ons 

The  following  recommendations  are  made  to  guide  future  research: 

1.  Optimal  tuning  should  be  accomplished  for  each  remaining 
trajectory.  The  robustness  of  each  set  of  tuning  specifi- 
cations should  be  investigated  to  find  which  set,  or  if  a 
compromise  set,  of  tuning  specifications  can  provide 
adequate  performance  over  all  trajectories. 

2.  The  performance  of  an  adaptive  gain  version  of  this  filter 
should  be  investigated  to  see  if  ihe  additional  performance 
achieved  is  worth  the  additional  filter  complexity. 

3.  First  order  Markov  models  for  missile  lateral  acceleration 
should  be  investigated.  This  model  should  provide  better 
performance  against  those  missiles  whose  guidance  docs  not 
approximate  the  proportional  navigation  rule.  In  addition, 
it  should  decrease  the  filter  complexity.  However,  this 
model  will  not  be  as  accurate  as  the  11-state  filter  if  it 
engages  a proporti onal  navigation  missile. 

A.  The  11-state  filter  should  be  tested  with  the  gravity  vector 
defined  along  the  -i2  axis.  If  feasible,  this  step  will 
simplify  the  filter  equations. 
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5. 


A missile  acceleration  model  based  upon  a polar  coordinate 
system  should  be  investigated.  It  might  be  possible  to 
model  both  the  missile's  acceleration  magnitude  and  the 
acceleration  vector's  position  angle  as  the  outputs  of  first 
order  lags.  Missile  roll  can  be  modeled  easily  this  way  as 
1 l»e  derivative  of  the  position  angle.  In  addition,  time 
lags  that  cause  a spiraling  missile  trajectory,  such  as 
in  the  sidewinder  missile,  would  be  easily  handled  by  this 
system.  However,  asymmetrical  missiles  may  cause  problems. 

6.  The  time  between  measurement  updates  should  be  lengthened 
to  discover  its  effects  on  filter  performance. 

7.  A thrusting  missile  should  be  modeled  to  increase  the 
effective  use  of  this  filter.  An  adaptive  filter  could 
change  the  (m/s)^,  state  to  an  acceleration  due  to  thrust 
state,  thus  modeling  thrust  as  a random  walk  without  an 
increase  in  states.  This  may  be  possible  if  missile 
thrusts  are  generally  much  greater  than  drag,  making  the 
drag  induced  by  the  missile's  lateral  acceleration 
negligible.  Otherwise,  drag  may  require  modeling  as  well 
as  thrust . 
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Appendix  A 


Notation  of  a Vector 

Throughout  the  missile  model,  numerous  rotations  of  a unit  vector 
must  be  accomplished,  such  as  in  the  application  of  noise  to  the  line 
of  sight.  This  appendix  describes  the  method  used  in  this  thesis  to 
detemine  the  resulting  direction  of  a unit  vector  after  one  planar 
rotation. 

Three  conditions  are  required  by  this  method: 

1)  Two  unit  vectors,  a and  b,  must  define  the  plane  of  rotation: 
p is  the  angle  of  rotation,  0 is  the  angle  between  a and  b. 

2)  Unit  vector  b is  the  vector  to  be  rotated,  resulting  in 
unit  vector  c. 

3)  Positive  0 is  from  a to  b;  positive  p is  from  b to  c. 

These  three  conditions  are  depicted  in  Figure  A-l.  The  angle  0 can  be 
found  through  the  dot  product  formula  to  be: 

0 = cos-1 (a  • b ) (49 ) 

With  the  given  conditions  and  the  defined  angle  G,  three  equations 
can  be  generated  to  describe  vector  c: 


(a  x b) 

1 O 

il 

o 

(30) 

a 

• C = cos 

( 0 + P ) 

(51  ) 

b 

• c = cos 

(p) 

(52) 
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Premultiplying  by  T-1  yields  c = T ]D. 


;x,2+  x22+  x3 


Xj  b ? X 3 - b 3 X 2 X2a3  - X,a2 

X 2 b 3 X j — b , X 3 X 3 a ( - X j a 3 

X 3 b j X 2 — b 2 X j X j a2  — X 2 a j 


where  X,  = a2b3-  a3b2 
X2  = a,b, - a, b j 
X3  = ajb2-  a2b j 

Solving  for  the  components  of  C yield: 


(b  »X, 

- b,X2 )cos(3+d)  + (X?a, 

- X,a 2 ) cos ( p ) 

C)  - 

"“xT7  + X22  + X3‘ 

(bjX, 

- b , X 3 )cos ( 0+p ) + (X,a1 

- X, a 3 )cos( o ) 

c2  - 

x , J + x2^  Tx'T7 

(b,X, 

- b,X, ) cos ( 0+p)  + (X,a? 

-X,a,  )cos(p) 

C 3 = 

X,2  + X22  + X32 

(5-1) 


The  computer  program  that  employs  this  technique  is  subroutine  TIN  in 
Appendix  D. 


ins 


Appendix  B 


Appendix  B contains  the  mathematical  derivation  of  the  filter 
state  equations.  The  eleven  states  used  in  the  filter  are: 

Oj  - first  Euler  rotation  from  inertial  frame  to  line  of  sight 
frame  (rad) 

0j  - second  Euler  rotation  from  inertial  frame  to  line  of 
sight  frame  (rad) 

w,  - inertial  angular  velocity  of  line  of  sight  frame  along 
first  line  of  sight  frame  axis  (rad/sec) 

«2  - inertial  angular  velocity  of  line  of  sight  frame  along 
second  line  of  sight  frame  axis  (rad/sec) 

- missile  position  relative  to  tracker  position  in  line  of 
sight  frame  (kiloft  = 103  ft) 

- rate  of  change  of  R^m  along  the  line  of  sight  (kiloft/sec) 
Aj i - lateral  acceleration  of  missile  along  first  missile 

velocity  frame  axis  (kiloft/sec2) 

A g - lateral  acceleration  of  missile  along  second  missile 
velocity  frame  axis  (kiloft/sec2) 
n^,  - proportional  navigation  constant 

- first  order  lag  time  constant  for  filter  model  of 
missile  (sec) 

(m/s)j.  - mass  to  effective  surface  ratio  of  missile  (slug/kiloft 2 ) 
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The  stale  units  are  so  chosen  to  insure  that  each  element  of  the  Kalman 


filler  gain  matrix  is  of  the  same  order  of  magnitude,  thus  avoiding 

computer  numerical  difficulties. 

Three  reference  frames  are  required  for  the  derivation:  the 

missile  velocity  frame,  v;  the  line  of  sight  frame,  1;  and  the  inertial 

frame,  i.  The  relationship  between  each  frame  is  part  of  the  derivation 

and  will  be  described  at  the  appropriate  time.  The  first  part  of  the 

derivation  develops  the  relationship  between  the  missile  velocity  frame. 

v,  and  the  line  of  sight  frame,  1,  in  terms  of  the  states. 

Let  j be  the  origin  of  the  inertial  frame;  m be  the  origin  of  the 

line  of  sight  frame,  and  t be  the  center  of  the  target  aircraft's 

radar.  The  missile  is  assumed  to  be  a point  mass  located  at  m.  The 

target,  t,  is  located  on  the  13  (line  of  sight  frame  third  component) 

axis  a distance  R . from  the  missile  (see  Figure  15— l) . The  vector 
mt 

relationship  between  the  points  j,  m,  and  t is: 


R . 
-jm 


-jt 


- R . 
— mt 


(55) 


Taking  the  first  derivative  of  equation  (55)  to  determine  missile 
velocity, 


p.  R.  = p.  R -p.  R 
— jm  ' i — jt  — mt 


where  p.  = rate  of  change  as  seen  from  the  i frame 
The  theorem  of  Coriolis  is 

R = pl  R + £ . ^ x R 


(56) 


(57) 


where  R - any  vector 
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0^  = angular  velocity  of  1 frame  with  respect  to  i frame 
= rate  of  change  as  seen  from  the  1 frame 
Substituting  (57)  into  (56)  yields 


p . R . = p . R . - p,  R - n . , x R 
' i — jm  — jt  r 1 — mt  — ll  — mt 


Equation  (58)  can  be  coordinati zed  in  the  1 frame  and  expressed  in 
vector  form  as: 


(p.  R.  )^  = (p.  R.,)1  - (p  R )]  - ( Si.,  x R ) ^ 
l — jm  * i — jt  '1  — mt  — ll  — mt 


V | fV 
mi  ti 


|Vm2  = Vt2'  " 


° - u2  x 0 


Vt3  VI 


Performing  the  operation  on  equation  (60)  yields  the  following  three 
scalar  equations  for  inertial  missile  velocity  coordinatized  in  the 
line  of  sight  frame: 


V = V - w,  R , 
mi  ti  2 mt 


V = V,  + u).  R . 
m2  t?  1 mt 


v = V - R , 
m3  1 3 mt 


V , V.  , and  V,  arc  the  inertial  velocities  of  the  target,  which  are 
ti  tj  ts 

obtained  from  the  target's  navigation  system.  These  values  arc 


considered  deterministic  since  the  measurement  precision  of  the  target 
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velocity  is  much  greater  than  the  measurement  precision  of  the 
states. 

The  v3  axis  of  the  right  hand  orthogonal  missile  velocity  frame, 
v,  is  defined  to  be  along  the  missile  velocity  vector.  Two  Euler 
angles,  a,  and  a2 , arc  defined  in  Figure  B-2  to  describe  the  rotations 
from  the  v frame  to  the  1 frame.  The  transformation  matrix  from  the 
v to  1 frame  is: 


v 


cosaj  sina , sina2 
0 cosa, 

since 2 -sina,  cosa2 


-cosa,  sina2" 
sina , 

cosa,  cosa2 


(64) 


The  relationship  between  the  missile  velocity  in  the  v and  1 frames  is: 


0 

0 

V 


cosa, ' 0 sina. 

sina,  sina2  cosa,  -sina,  cosa2 
-cosa,  sina2  sina,  cosa,  cosa2 


m 2 


m 3 


(65) 


Solving  equation  (65)  for  the  first  component  of  the  missile  velocity 
in  the  v frame,  and  substituting  in  equations  (62)  and  (63)  yields: 


a2 


tan-1 


f-V,  + o) 2 K 
ti  mt  I 

V,  - R , I 

i 1 3 mt  / 


(66) 


Solving  equation  (65)  for  the  second  component  and  using  equations  (61), 
(62),  and  (63)  yields: 


a,  = tan  1 


^2  + W,  R. 


mt 


( V . - K . )coStt,  - (V.  - ui,  R . )sina, 

"*■  2 ti  2 mt  2 


\ t3  mt 


(67) 
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If  equation  (66)  is  solved  for  - (V  - w2  .. 
equation  (67),  equation  (67)  reduces  to: 


R ) and  substituted  into 


a,  - tan" 


(V,  + to,  R . ) cosot, 

1 2 * mt  1 


(68) 


' Vt3  Hmt 


Since  R . = -R,  and  R = -R  , 
mt  tm  mt  tm 


a,  - tan 


ax  = tan 


-V  - w2  R 
1 1 1 tm 


V.  + R, 

1 3 tm 


(V.  - u,  R,  )cosq5 

1 2 1 tm 


V,  + R. 

1 3 tm 


(69) 


(70) 


Thus,  the  relationship  between  the  v and  1 frames  is  established  in 
terms  of  the  states.  Note:  a,  and  ct2  are  the  Ruler  angles  from  the 
missile  velocity  to  the  line  of  sight.  If  the  two  limits,  -tt/2  <a,  < tt / 2 , 
-it/2  < a2  < tt/2  are  exceeded,  it  can  be  assumed  that  the  missile  is  in 
an  invalid  regime  for  intercept. 

The  proportional  navigation  law  is  used  to  develop  state  equations 
for  Aj  and  A^.  This  law  in  equation  form  is  (Ref  11:13) 


A 

-P 


= 


X Rlm) 


(71) 


where  A = acceleration  required  perpendicular  to  the  line  of  sight 
~P 

and  £--j 

= line  of  sight  inertial  angular  velocity 
n - proportionality  constant 


However,  missiles  produce  accelerations  perpendicular  to  the  missile 
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velocity,  not  the  line  of  sight  (see  Chapter  IT,  Guidance  Block,  for 
more  detail).  The  proportional  navigation  equations  most  missiles 
implement  are: 


A 

Cl 


n oi2 


tm 


(72) 


A = -n  to , 

C 2 1 


(73) 


where  A and  A are  commanded  accelerations  perpendicular  to  the 
missile  velocity. 

To  obtain  A^  and  A g,  the  produced  accelerations,  the  time  response 
of  the  missile  must  be  taken  into  account.  Cusumano  and  DcPonte  found 
that  the  time  response  of  a'  missile  can  be  adequately  modeled  by  a first 
order  lag,  since  the  bandwidth  effects  of  the  guidance  prefilter  arc- 
dominant  (Ref  1:117).  Using  this  model,  equations  (72)  and  (73) 
become 


n.  idj  R 

. f 2 tm 

LI  “ alf  + 1 

-n  w,  R, 
f 1 tm 

”L2  _ -di  + 1 


(7/1) 


(75) 


where  a - Laplace  transform  " 
Manipulation  of  equations  (74) 


A 


LI 


s 


I* 


and  (75)  yields 


n to 


? H4 

2 tm 


Tf 


(76) 


Tf 


) 


which  arc  the  state  equations  of  Af  ^ and  A^  ,,  in  terms  of  Die  other 
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states. 


states.  To  allow  possible  asymmetrical  missile  response,  the  n „ and/or 
Tj.  could  be  different  between  equations  (70)  and  (77),  adding  one  or 
two  additional  filter  states.  This  concept  is  not  investigated. 

To  develop  state  equations  for  states  Uj  , ili2  , and  R , the  accelera- 
tion of  tfie  missile  in  the  line  of  sight  frame  is  derived.  The  second 
derivative  of  equation  (55)  is: 


p . 2 R . = p . 2 It . - r> . 2 R 
1 i — im  1 i —it  *i  — n 


at 


p.  2 R . = p . 2 R . , + p . 2 It . 
j — jm  *i  — jt  i — tm 


(78) 

(79) 


Applying  the  theorem  of  Coriolis  (equation  (57))  twice  to  equation  (79) 
yields : 

p ■ 7 R . , = p ■ 2R  . , + p-,2R,  + 2n.,  x p.,  R + p.p.,  x R . + 

i -jm  *i  jt  .1  -tn  -il  h 1— tm  *1-:1  -tm 


fl.  x (fi . , x It.  ) 
—i  1 —l  1 — tm 


Coordinati zing  equation  (80)  into  the  1 frame, 


(80) 


A 

[A.  ; 

' 0 

| 

2 a)  i 

i 

0 

• 

0),' 

o ' 

mi 

ti 

A 

m2 

= 

At2 

+ 

0 

+ 

2 a' 2 

X 

0 

+ 

• 

0)2 

0 

• 

• 

, 

A 

A, 

R , 

2a)  3 

R , 

0)  , 

R 

m3. 

L tsj 

tm. 

tm. 

- tm. 

“i' 

0 

“2 

X 

u2 

X 

0 

(j>  3 

w3 

R, 

tm. 

(81) 


where  A , A , A = inertial  acceleration  of  missile  along  1,,  1 , , 1 
m i m 2 m3  t — 1 ’ — - ’ — 


axes,  respectively 
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A.  , A,  , A,  = inertial  acceleration  of  tracker  alone  1.,  1,,  1. 

tl  t2  t3  " — 1 — — 3 

axes,  respectively 


The  acceleration  of  the  target  is  assumed  to  be  deterministic  and 
known  to  the  estimation  algorithm  residing  in  the  target.  The  inertial 
acceleration  of  the  missile,  is  composed  of  gravity,  induced 

accelerations  (A^  ^ and  A^),  and  drag  ( ) . Note  that  the  missile  is 
modeled  as  non-thrusting.  In  addition,  the  lateral  accelerations,  A 
and  Aj 9 , are  assumed  to  be  along  the  v,  and  v2  axes,  respectively;  this 
assumption  requires  the  missile  angle  of  attack  to  be  small,  which  is 
quite  appropriate.  Moreover,  the  missile  must  not  roll  with  respect 
to  the  v frame.  The  zero  roll  assumption  is  not  appropriate  when 
missiles  are  roll  stablized,  nor  may  it  be  appropriate  when  the  line  of 
sight  frame  rotates  with  respect  to  the  inertial  frame.  Two  effects 
degrade  the  validity  of  the  zero  roll  assumption  when  the  line  of  sight 
rotates  - model  induced  roll  and  induced  missile  roll.  Model  induced 
roll  is  present  when  the  angle  between  the  line  of  sight  vector  and 
the  missile  velocity  vector  changes.  It  is  caused  by  the  definition 
of  a,  and  a2  in  the  model,  i.e.  constraining  the  v frame  to  the  rotating 
1 frame  rather  than  to  the  non-rotating  inertial  frame.  Induced 
missile  roll  is  a physical  phenomena  caused  by  the  missile's  inertial 
turn  (see  Chapter  II,  Target  Model). 

Model  induced  roll  is  demonstrated  by  analyzing  the  three  coordi- 
nate frames  (i,  v,  and  1)  and  their  relationship  to  each  other.  The 
v2  axis  is  constrained  to  the  (lz,  13)  plane,  and  the  _1_2  axis  is 
constrained  to  the  ( i , , j_3 ) plane  by  the  model's  definitions.  In 
Figure  B-3,  the  v2  axis  is  in  the  (i,,i3)  plane.  But  in  this  same 
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Fig.  B-3.  11  State  Filter  Model's  v2  Relationship  for  Time  tj 
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scenario  at  a later  time  instant  as  depicted  in  Figure  B— 1 , the  l ine  of 
sight  vector  lias  moved.  Although  the  missile  does  not  physically  roll, 
the  v,  axis  must  be  in  a different  plane  to  remain  in  the  (1.,  ) 

plane.  To  achieve  this  effect,  there  must  be  an  inertial  angular 
velocity  along  the  v3  axis,  i.e.  the  model  must  roll.  The  amount  of 
roll  induced  by  the  model  is  trajectory  dependent. 

The  model  induced  roll  can  be  eliminated  if  al  and  a2  are  defined 
as  Euler  rotation  angles  from  the  v to  i f ranie  rather  than  from  the  v 
to  1 frame.  But  the  mathematics  become  more  complex.  In  many 
encounters,  the  missile  velocity  is  much  greater  than  the  aircraft 
velocity.  This  results  in  a small  missile  lead  angle.  Model  induced 
roll  effects  become  less  significant  as  the  lead  angle  becomes  small, 
and  vanish  completely  for  zero  lead  angle.  Therefore,  an  assumption 
is  made  that  the  model  induced  roll  effects  will  be  insignificant.  This 
assumption  must  be  verified  by  the  Monte  Carlo  analyses. 

The  induced  missile  roll,  however,  is  a physical  phenomena  asso- 
ciated with  the  actual  missile.  As  a missile  performs  a turn,  a roll 
is  induced  upon  it.  A full  explanation  of  this  effect  is  presented  in 
Chapter  II,  Target  Model.  Two  methods  can  be  used  to  account  for  this 
roll  - direct  modeling  and  indirect  modeling.  In  the  direct  method, 
the  three  dimensional  missile  model  is  rotated  the  appropriate  amount 
as  calculated  by  an  accurate  model  of  induced  missile  roll.  In  the 
indirect  method,  the  three  dimensional  missile  model  is  developed  for  a 
missile  that  rolls.  The  missile  roll  is  modeled  as  a constant  parameter 
plus  a white  Gaussian  noise  of  appropriate  strength.  However,  these 
techniques  are  not  employed  since  it  is  assumed  that  induced  missile 
roll  effects,  present  only  when  the  line  of  sight  rotates,  are  negligible. 
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rotation  about  v3 
axis  (roli)  to 


maintain  v?  in  the 
( 3 2 » 1 3 ) plane 


Fig.R-4.  11  State  Filter  Model's  v?  Relationship  for  Time  t2 
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With  these  assumptions,  then,  the  inertial  acceleration  of  the 


k 


missile,  in  the  v frame,  is: 


(p.2n.  )v  = 
- -jm 


1.1 


L2 

-A„ 


+ CV  G1 

1 — 


(82) 


where  C.  = the  transformation  from  the  i frame  to  the  v frame 

1 


G = gravity  vector  in  the  i frame 


Multiplying  each  term  of  equation  (82)  by  C from  equation  (64)  tr 

V 

forms  the  missile  acceleration  to  the  1 frame: 


ans- 


(p.2R.  ) = 

* i -jm 


1.1 

cosa2 

+ sina2 (Aj g 

s i n a j 

+ ad 

COSttj  ) 

L2 

cosa , 

- Au  sina, 

'Ll 

si  na  2 

- cosa2 (Aj ? 

sina! 

+ ad 

COStt] ) 

+ c!  G1 

l — 


(83) 


To  define  gravity  in  the  1 frame,  the  transformation  from  the  inertial 


,1 


frame  to  the  1 frame,  C. , must  be ' specified.  With  0,,  02,  and  the 


coordinate  frame  relationships  as  depicted  in  Figure  B-5,  the  transfor- 
mation from  the  i to  1 frame  is: 


c]  = 

l 


-cosGj  sin02  cos02  sinOj  sin02 
sin0]  0 cosO! 

cosO,  cos©.,  sin02  -sinO,  cos02 


(84) 


At  this  point,  an  interesting  dilemma  develops.  If  gravity  is 


defined  to  be  in  the  -i 2 direction,  C G has  no  component  that  is 


dependent  upon  0,.  Therefore,  none  of  the  states  are  a function  of  0,. 
It  is  felt  that  this  weak  coupling  of  0,  might  have  an  adverse  effect 
upon  filter  performance.  This  hypothesis  is  not  tested  due  to  time 
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1 i mi  tali ons . 


To  tost  it,  the  truth  model  gravity  vector-  must  be  defined 


in  the  -i2  direction  and  all  terms  involving  G,  must,  be  eliminated  in 
the  filter  equations  (sec  Appendix  B).  Therefore,  the  filter's  inertial 
coordinate  frame  is  physically  rotated  15°  about  the  i,  axis,  such 
that : 


G1  = -g//2 

,-g//2 


where  g = acceleration  due  to  gravity  (kiloft/sec? ) 

This  definition  of  the  inertial  frame  couples  both  e,  and  02  into  the 
filter  equations,  avoiding  a weakly  coupled  state.  In  the  computer 
simulation,  the  missile  truth  model  is  also  physically  rotated  45° 
about  the  i,  axis  of  the  truth  model's  inertial  frame.  Thus,  the 
filter's  i frame  and  the  truth  model's  i frame  have  identical  orienta- 
tion. This  allows  the  truth  model  states  to  be  directly  utilized, 
after  unit  conversion,  for  filter  measurements  and  analysis.  Putting 
equation  (84)  and  (85)  into  (83),  and  the  resulting  equation  into  (81) 
yields  the  three  scalar  equations  for  missile  acceleration: 


^ cosa2  + sina2(Aj2  sina 


, , g(cos0,  + sinO,  sin©,) 

, + A cosa,)  - 1 ' — = 

1 T 1 1 /%*.• 


A.  + 2a),  R,  + (i)j  R.  + w * (i) * K . 

1 1 z tm  z tm  1 3 tm 


p cos©,  • • 

A,  „ cosa,  - A_  sina,  - - = A,  - 2 w,  R,  - u,  IP  + 

1.2  1 D 1 1 2 1 tm  1 tm 


“z  “3  Rtm 


I 


Aj  j sina2  - cosajfAj^  sinoij  + Af)  cos'.a,)  - — r— (sin02  - sinoj  cos02)  - 


/2 


A + R - (id,  2 + a>j  2 ) R 
1 3 tm  1 ‘ 1m 


(88) 


Now  an  expression  for  u3  must  be  generated.  From  equation  (84)  and 
Figure  53,  the  state  equations  for  Gj  and  02  are  developed  as 


6i  = “i- 


0,  = tO  o 


(89) 

(90) 


where  w.  = the  inertial  angular  rate  of  the  line  of  sight  frame  along 
i 2 

the  i2  axis 

Notice  that  equation  (84)  requires  the  line  of  sight  frame  inertial 
angular  rate  to  be  a vector,  in  the  (i2,  12)  plane.  This  can  only 
happen  if  the  vector  sum  of  the  line  of  sight  angular  velocities  which 
lie  along  the  j_j  and  12  axes  points  in  the  j_2  direction,  i.c. 


0), 


+ 0)  , 


(91) 


which  is  depicted  in  Figure  B-6.  Taking  the  dot  product  of  each  term  of 
equation  (91)  with  i2  yields 

w,  cos02  + to3  sine,  = w.  (92) 


From  the  Pythagorean  theorem, 


ui3  = oi j tan02 


(93) 


12.? 


Substituting  equation  (93)  into  (92)  and  the  result  into  (89)  yield: 


0,  = id,  seco. 


Substituting  equation  (93)  into  (87),  (86),  and  (88);  and  then  solving 

• • ••  t 

for  w,,  id,,  and  R,  yields  the  state  equations  for  u,  , id,,  and  R,  : 

trn  1 1 2 tm 


= "t  [A°  SinQl  " Au 


O COSO,  • 

cosa,  + 1-  + A,  - 2 id.  R. 

/2  t?  lm 


+ u,  id g R^m  tan02 


^ — Aj 1 cos«2  + si na2 ( Aj  ^ sina,  + A^  cosa,)  - ~ 
tm  ' /2 


( cos©  2 + sine,  sin02 ) - A,  - 2w2  R , - w,2  R,  tanO,  (96) 

ti  2 tm  1 tm  2 


Rtm  = Ai  i S3na2  “ (Aj  2 sina,  + A]}  cosa,)cosa2  - — 

/2 


(sin02  - sin9,  cos02)  - A + (id,2  + w22)R 


where  g = the  acceleration  of  gravity  (ki loft/sec2 ) 

A^  = acceleration  due  to  drag  (kiloft/sec2 ) 

The  acceleration  of  drag  can  be  approximated  as  (Ref  1:58) 


p /a  V 3 2 (m/s)  ( A + A 2 ) 

, m f LI  L2 

A + 

1 (m/s)  p a V (57.3) 

f m 


where  p = air  density  (slugs/ki loft 3 ) 


a = speed  of  sound  (kiloft/sec) 
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V = velocity  maiuii  tude  of  Hit-  missile  (k  i 1 of  1/sec  ) 
m 

57.3  radian  to  decree  conversion 

Note  that  neither  !. utter,  who  developed  this  approximation,  nor 
Cusumano  and  DoPonte,  include  the  conversion  factor  in  the  text  of 
their  theses.  However,  both  use  it  in  the  computer  propram  (Kef  5:209) , 
Therefore  it  is  included  here  to  provide  appropriate  scaling.  This 
approximation  is  within  3%  of  the  truth  model  value  for  drag. 

The  missile  velocity  ran  be  found  in  terms  of  the  states  from 


equations  (61)  through  (63): 


V =Jv2  T\'2  " V2 

m t mi  nn  m3 


Thus,  tlie  state  equations  for  the  first  eight  states  have  been  completely 
speci fied. 

The  final  states,  n^.,  t^,,  and  (m/s)^,  are  constant  parameters. 

Since  the  missile  model  used  by  the  filter  is  not  exact,  it  is  possible 
for  the  filter  to  acquire  an  incorrect  initial  parameter  estimate. 

If  the  parameters  are  modelled  as  a random  bias,  the  gain  in  the 
extended  Kalman  filter  approaches  zero,  inhibiting  corrective  changes. 
Thus,  this  filter  model  is  inappropriate.  To  prevent  this  phenomena, 

pseudonoise  can  be  added  to  each  parameter  model  (Ref  7:204),  changing 

• • 

Die  model  from  a form  such  as  b = 0 to  b = W.  Through  appropriate 
choice  of  the  pseudonoise  variance,  the  filler  gain  will  be  large 
enough  to  compensate  for  errors,  yet  small  enough  to  maintain  the 
essentially  constant,  nature  of  the  parameters.  This  technique  proved 
successful  in  the  two  dimensional  case  (Ref  1:118).  The  state 


equations  for  the  parameters  are,  therefore: 
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r 


nf  - W, ( t ) 

(300) 

T = W2(t) 

(301  ) 

(m/s) ^ - W,(t) 

(102) 

where  Wj(t),  W2(t),  and  W3(t)  are  independent  white  Gaussian  noises 
with  mean  of  zero  and  variance  kernels  Q,S(t),  Q2S(t),  and  Qs6(t) 
respectively. 

The  final  state  equations,  as  used  by  the  filter,  are:  NOTE:  IF 
gravity  is  defined  in  the  -i 2 direction,  ALL  terms  with  0,  in  the 
following  equations  are  zero. 

0j  - to j sec02  (94) 
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where 


"nf  “2  Rtm  “ A!,2 


L2 


nf  = W , ( t ) 

T ^ = W 2 ( t ) 
(in/s)^  = W 3 ( t ) 


p/a  \'n  3 2(m/s)r  ( A 2 ^ + A29) 

ad  = * ; 


(m/s) , 


p a Vm  (57.3) 


a 2 - tan-1 
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1 1 2 mt 
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a,  = tan-1 
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( 76 ) 

(77) 
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(101  ) 
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(98) 
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iii  i m 2 ni  3 


V = V.  - uk  R . 
in  i ti  7 mt 


V = V,  - id  R . 
m2  12  i mt 


V = V4  - K 
m3  1 3 ml 


The  partial  derivatives  of  these  state  equations,  which  are 
required  by  an  extended  Kalman  filter,  are  contained  in  Appendix  D, 


Subroutine  FMAT . 
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. A previously  designed  extended  Kalman  filter,  based  upon  the  proportional  ! 
guidance  law,  aerodynamic  dra^ equation,  and  a first  order  lag  model  of  the 
missile  time  response;  is  modified  for  three  dimensional  use.  Its  purpose  is  to  j 
estimate  various  states  of  an  offensive  missile  by  processing  the  line  of  s' phi  | 
measurements  made  l\v  the  target  aircraft.  A six-dcgrcc-of-frccdoT. , stochastic 
missile  model  is  developed  and  presented  in  Fortran  code.  Monte  Carlo  analyses- ..j 
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of  the  filter’s  pctfoir  ar.ee  arc  general  ed  for  four  different  trajectnri  cs. 

These  trajectories  test  for  different  orientations  of  the  line  of  sight, 

(..i  feivnt  acc-e  1 oration  profiles  of  tin.  missile,  and  diiferent  amount  of  roll 
induced  upon  the  r;ii;.  ilu  by  a three  dimensional,  conic  turn. 

The  extended  Kalman  filter  is  designeo  in  the  line  of  sight  frarne  and  i v 
composed  of  eleven  states.  They  are:  two  line  of  sight  orientation  angles:,  too 
inert  ill  annular  \eloeit  .iv-s  of  the  line  of  si  phi  , range,  closing  velocity,  two 
lateral  accelerations  of  i hi  rtisvi  le,  and  three  constant  parameters.  The 
constant  parameter:,  are  the  proportional  navi  nation  con. tan!  (which  exploits 
ai  assumed  missile  guidance  scheme),  a time  constant  (for  the  first  order  lag 
model  of  missile  time  response),  and  the  missile's  mass  over  surface  ratio 
{for  computing  aerodynamic  drag  of  the  missile) , The  filter  assume  that  the 
missile  is  non-rolling  with  rv.  et  to  the  line-  of  sight  frame,  and  that  the 
line  of  right  frame  is  ron-roii i ng  with  respect  t.o  the  inertial  frame.  It 
also  assumes  that  the  missile  is  non-t!. rusting. 

/ 

Preliminary  results  ere  promising.  The  filter  is  only  tuned  for  one  trajec- 
tory due  to  time  limitations,  yet  its  estimation  of  the  pointing-tracking  slat-  ■ 
provide  good  aiding,  for  all  trajectories.  Parameter  estimates  and  missile 
! a.’rl  oration  estimates  for  the  other  trajectories  are  degraded  due  to  improper 
I tuning  of  two  parameters.  However,  it  is  felt  that  additional  tuning  of  those 
parameter:  will  i ncrease  the  filter *s  accuracy  for  the  dther  trajecto  es.  Plot 
of  the  Monte  Carlo  result;,  are  provided,  as  well  as  the:  Fortran  computer 
piogran  used  in  the  simulation. 
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